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SUMMARY 


The  primary  results  of  the  research  efforts  are  the  following: 

1.  Development  of  an  approach  for  real  time  on-board  estimation  of 
spacecraft  orientation  with  sub  five  arc-second  precision. 

2.  Detailed  formulation  of  an  efficient  and  reliable  star  pattern 
recognition  strategy  appropriate  for  use  with  charged-coupled- 
device  (CCD)  array-type  star  sensors. 

3.  Formulation  of  a  motion  integration/Kalman  filter  algorithm  to 
integrate  gyro  measured  angular  rates  and  (by  sequential  processing 
of  the  discrete  orientation  information  available  from  the  star 
sensing,  identification,  and  attitude  determination  process) 
provide  optimal  real  time  estimates  of  spacecraft  orientation  and 
angular  velocity. 

4.  Development  of  truth  models  to  generate  realistic  input  data  for 
the  star  pattern  recognition  and  Kalman  filter  strategies. 

5.  Formulation  of  algorithms  using  Euler  parameters  to  define  orien¬ 
tation. 

6.  Implementation  and  validation  of  the  approach  in  a  laboratory 
microcomputer  -  the  objective  being  to  assess  the  problems  asso¬ 
ciated  with  a  real-time,  on-board  version  of  this  system. 


These  results  are  discussed  in  detail  herein.  This  report  is 
organized  in  such  a  fashion  that  the  key  features  and  results  of  the 
work  are  discussed  in  the  main  body  of  the  text;  the  more  involved  and 
technical  details  are  documented  in  the  ten  appendices. 
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1.0  Introduction 


This  document  reports  the  findings  of  a  three  year  research  project 
to  develop  a  method  for  on-board  satellite  attitude  determination.  We 
believe  this  method  can  achieve  sub-five-arcsecond  accuracy  when  applied 
to  data  obtained  with  a  new  general  purpose  star  tracker  (typical  of 
several  existing  configurations). 

The  primary  motivation  for  the  research  is  the  exploitation  of 
recently  developed  light  sensitive  Charge-Coupled-Devices  (CCD)  arrays, 
placed  in  the  focal  plane  of  a  tracker  lens,  to  act  as  a  "film"  for 
imaging  starlight.  Satellite  attitude  can  be  determined  by  identifying 
the  stars  detected  by  the  CCD.  The  star  image  data,  output  from  the 
CCD,  can  be  either  telemetered  to  ground  for  later  analysis  or,  as 
described  in  this  report,  analyzed  on-board  (via  computers  configured  in 
parallel)  to  determine  satellite  attitude  autonomously  in  near  real-time. 

The  basic  system  we  propose  consists  of  2  or  3  CCD  star  trackers 
and  3  microcomputers,  each  with  a  dedicated  function.  The  function  of 
each  of  the  4  sub-systems  is  outlined  below,  with  reference  to  Figures 
1.1,  1.2,  and  1.3. 

1.1  System  Overview 

(1)  CCD  Star  Sensors  and  Associated  Electronics 

Although  the  development  of  CCD  sensors  and  trackers  is  not 
part  of  this  research,  there  are  several  CCD  star  tracker  designs 
proposed  by  various  organizations  Involved  in  hardware  development. 
The  purpose  of  our  work  has  been  exploitation  of  the  CCD  star 
tracker  technology;  we  have  chosen  a  particular  set  of  parameters 


Figure  1.1  UVASTAR  An  electro-optical/software  system  capable 
of  real  time  readout  of  digitized  star  coordinates, 
and  ultimately,  autonomous,  near-real  time  star 
pattern  recognition  and  attitude  determination. 
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Figure  1.2  Formation  of  Image  on  the  CCD  Array 
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but  it  should  be  kept  in  mind  that  these  are  nominal,  achievable 
values  without  further  CCD/star  tracker  technology  advances.  Each 
of  the  two  (or  three)  trackers  is  identical  and  their  boresights 
are  assumed  separated  by  the  nominal  interlock  angle  of  90°.  We 
assume  a  lens  focal  length  of  70  mm  and  a  CCD  array  size  such  that 
a  7°  x  9°  field  of  view  (FOV)  is  imaged  onto  the  array.  The  arrays 
are  assumed  to  be  Fairchild's  11.4  mm  x  8.8  mm  matrix  consisting  of 
488  x  380  silicon  pixels,  each  pixel  accurately  imbedded  (to  1  part 
in  10,000)  in  a  microcircuit  chip.  Starlight  is  defocused  slightly 
on  the  CCD  in  order  to  spread  typical  images  over  9  to  16  neigh¬ 
boring  pixels.  This  permits  accurate  "centroiding"  of  the  image  to 
determine  image  coordinates  accurate  to  about  10%  of  a  pixel 
(10%  is  a  conservative  estimate).  The  processing  of  a  data  frame 
consists  of  a  rapid  sequential  readout  of  the  voltage  response  of 
all  pixels  and  an  analog  to  digital  (A/D)  conversion  only  of  cer¬ 
tain  pixels  (based  upon  response  above  an  analog  threshold  level  or 
prior  selection).  The  scans  of  each  field  of  view  are  controlled 
by  a  common  clock  and  are  assumed  to  represent  2  (or  3)  frames  (1 
from  each  sensor)  taken  at  the  same  instant.  This  assumption  is 
valid  for  all  but  very  rapidly  spinning  satellites,  since  the  CCDs 
can  be  scanned  10  times  per  second.  (Refer  to  Appendix  1  for  more 
star  tracker  information.) 

(2)  Microcomputer  A 

Program  Pn.oc.eA*  A  is  performed  by  a  Microcomputer  A  with 
either  one  computer  per  sensor  or  sequential  treatment  of  data  for 
2  or  3  sensors.  Again,  Process  A  is  not  part  of  this  research 
program  but  since  the  functions  to  be  performed  are  straightforward, 
we  simply  replace  Process  A  by  calculating  synthetic  output  data 


whose  availability  is  clock  controlled.  Process  A  takes  as  input 
data  the  digitized  pixel  voltages  and  pixel  coordinates  for  up  to 
10  stars  in  each  FOV  and  the  associated  time.  Image  centroids  are 
calculated  for  each  image  and  corrections  for  lens  distortion  and 
other  known  error  sources  are  applied;  a  relative  magnitude  or 
intensity  is  also  calculated.  As  output.  Process  A  delivers  the 
focal  plane  coordinates  for  each  star  image.  Since  Process  A 
calculations  for  one  data  frame  can  be  performed  in  near  real  time 
and  many  times  faster  than  the  attitude  can  be  determined,  it  may 
be  possible  and  desirable  to  perform  additional  editing  of  the  star 
data.  For  example,  images  with  rapidly  varying  image  intensity 
from  frame  to  frame  could  be  eliminated  or  images  whose  successive 
positions  are  inconsistent  with  the  overall  motion  caused  by 
vehicle  motion  (such  as  images  of  space  debris)  could  be  deleted 
immediately  from  consideration  (failure  to  detect  and  delete  all 
spurious  images  does  not  prove  fatal,  but  does  slow  the  pattern 
recognition  logic  of  Process  B).  Process  A  would  be  expected  to 
output  image  coordinate  and  magnitude  data  at  the  rate  of  about  5 
frames  per  sensor  each  minute  and  simply  overwrite  old  data.  The 
microcomputer  of  Process  A  is  considered  as  an  integral  part  of  the 
star  tracker  itself,  making  it  a  "smart  sensor". 

Since  Process  A  controls  the  scan  of  the  CCD  and  its  electronics, 
it  is  possible  to  track  only  those  stars  desired  (those  whose  pixel 
response  lies  within  specified  bounds).  Thus,  even  though  the  CCD 
array  contains  thousands  of  pixels,  only  a  small  fraction  of  their 
response  values  need  be  subjected  to  A/D  conversion  and  stored  at 
any  one  time.  It  is  this  data  compaction  feature,’  along  with  the 


high  dimensional  stability  of  CCD  arrays  that  make  them  so  attractive 
for  this  application.  Also  significant  is  the  high  speed  readout 
of  the  CCD  which  allows  one  to  assume,  for  most  cases,  that  the 
star  images  visible  in  a  given  frame  have  been  imaged  simultaneously. 
Therefore,  stellar  resection  (geometric)  methods  can  be  used  for 
attitude  determination  and  the  vehicle  motion  can  be  ignored  for 
anaylsis  of  a  single  frame  of  data. 

(3)  Microcomputer  B 

Data  from  Process  A  (and  Process  C)  are  analyzed  by  program 
P/tocea*  8;  again  by  means  of  a  dedicated  microcomputer.  As  input. 
Process  B  accepts: 

•  star  image  coordinates  and  magnitude  data;  one  set  per  FOV 
(from  Process  A); 

•  a-priori  attitude  estimates  and  covariance,  (from  Process  C); 
and 

•  a-priori  estimates  and  covariance  of  interlock  angles  between 
the  sensors  image  planes  (from  previous  analysis  of  Process  B 
data) . 

The  sequence  of  calculations/logical  decisions  divides  into 
two  primary  functions: 

•  identify  measured  stars  in  each  FOV  as  specific  stars  contained 
in  an  on-board  star  catalog  (containing.  In  the  general  case, 
the  direction  cosines  and  instrument  magnitudes  of  the  5000 
brightest  stars)  and 

•  determine  the  spacecraft  orientation  and  field  of  view  inter¬ 
lock  angles  which  cause  the  simulated  images  of  identified 
catalog  stars  to  overlay  the  corresponding  measured  Images  in  a 
least-squares  sense. 


These  two  tasks  will  be  discussed  in  detail  in  Section  3  and 


appendices.  The  expected  output  rate  for  Process  B  is  two  or  more 
attitude  updates  per  minute  of  elapsed  time.  The  old  attitude  and 
covariance,  output  to  Process  C,  are  overwritten  by  each  new 
attitude  and  covariance. 

(4)  Microcomputer  C 

The  attitude  determined  by  Process  B  for  a  discrete  time  is 
further  processed  by  program  Process  C  in  microcomputer  C.  Input 
to  this  program  consists  of  the  attitude  and  covariance  from  Process 
B  and  A/D  converted  gyro  rate  measurements  of  angular  velocity. 

The  kinematic  differential  equations  governing  the  spacecraft 
attitude  are  integrated  forward  from  the  attitude  determined  from 
the  previous  pass  through  Process  C  (using  the  gyro  rate  measurements). 
This  yields  an  attitude  estimate  at  the  time  associated  with  the 
next  set  of  image  coordinates  from  Process  A.  After  Process  B  has 
determined  the  discrete  attitude  it  is  combined  with  the  integrated 
attitude  in  a  Kalman  Filter  calculation  to  give  a  best  estimate  of 
attitude  at  the  time  associated  with  the  star  tracker  data. 

Further  forward  integration  gives  an  estimated  attitude  and  co- 
variance  at  real-time. 

1.2  Focus  of  This  Study 

Our  primary  tasks  were  to  develop  the  algorithms  for  Process  B 
(star  pattern  recognition  and  attitude  determination),  and  Process  C 
(state  integration  and  Kalman  filter  routines).  This,  of  course,  required 
some  study  of  CCD  arrays  and  star  tracker  design  (Process  A).  A  gov¬ 
erning  principle  was  that  this  system  be  suitable  for  a  general  purpose 
satellite;  that  is,  we  did  not  design  it  with  a  particular  mission  in 
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mind.  We  have  required  a  slowly  rotating  satellite,  however,  in  order 
to  insure  that  star  images  do  not  cause  streaks  in  the  star  camera  and 
that  our  rate  integration  be  valid  (i.e.,  the  vehicle  not  undergo  rapid 
maneuvers). 

The  algorithms  we  devised  can  run  on  a  large  memory  (64,000  bytes), 
general  purpose  microcomputer.  To  demonstrate  this,  we  have  programed 
the  algorithms  on  a  Hewlett-Packard  9845S  microcomputer  equipped  with  a 
high  level  BASIC  interpreter  language  package.  Although  the  processing 
time  with  this  language  is  significantly  slower  than  a  compiler  type  of 
system  or  machine  code  program  its  use  permitted  programming  ease,  which 
was  essential  for  development  work.  Our  tests  show  the  present  system 
will  produce  updated  attitude  estimates  every  60  seconds  (with  rate 
integrated  attitude  available  several  times  per  second)  in  a  steady 
state  mode;  when  the  programs  are  implemented  in  a  form  suitable  for  a 
satellite  computer  they  should  execute  much  faster. 

We  have  organized  this  report  to  include  most  of  the  detail  and 
mathematical  developments  in  appendices  in  order  to  keep  the  body  des¬ 
criptive  and  concise.  Section  2  discusses  the  coordinate  frames  and 
orientation  variables  used  in  this  study.  Processes  B  and  C  are 
described  in  Sections  3  and  4,  respectively.  We  discuss  our  truth  model 
and  simulation  tests  of  our  algorithms  in  Section  5  and  present  con¬ 
clusions  in  Section  6.  The  reader  is  referred  to  references  1-3  for  a 
discussion  of  intermediate  results  of  this  project. 
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2.0  Orientation  Parameters  and  Coordinate  Frames 

In  order  to  describe  the  orientation  of  a  spacecraft  we  need  to 
specify  some  coordinate  frame  fixed  in  the  vehicle  and  another  fixed  in 
Inertial  space.  In  addition,  we  need  a  parameter  set  to  describe  the 
relative  orientation  of  these  two  frames. 

Euler  angles  provide  an  easily  understood  description  of  relative 
orientation  of  two  frames.  The  three  angles  specify  a  sequence  of 
rotations  about  three  successive  coordinate  axes  of  a  rotated  frame. 
However,  although  they  are  descriptive,  Euler  angles  are  not  very 
suitable  for  our  purposes  for  several  reasons.  Any  of  the  twelve 
possible  rotation  sequences  possesses  two  singularities.  In  addition, 
the  differential  equations  describing  the  rotational  motion  of  a  vehicle 
involve  trigonometric  nonlinearities  when  expressed  in  terms  of  Euler 
angles.  The  same  is  true  of  the  least-squares  equations  used  in  the 
star  pattern  recognition  algorithms.  Extensive  use  of  trigonometric 
functions  will  significantly  increase  the  computation  time. 

2,1  Euler  Parameters 

These  problems  have  been  circumvented  by  using  a  set  of  four 
variables  called  Euler  parameters  instead  of  Euler  angles.  Euler  param¬ 
eters  have  the  advantages  that  (1)  they  do  not  have  a  geometric  singu¬ 
larity,  (2)  they  rigorously  satisfy  linear  differential  equations,  and 
(3)  no  evaluation  of  trigonometric  functions  need  be  done  in  any  applica¬ 
tion  discussed  herein.  One  disadvantage  is  the  four  parameters  must 
sum-square  to  unity;  we  have  found  methods  to  include  this  constraint  in 
our  estimation  algorithms. 

Euler  parameters  (Bo,  $i,  62,  B3)  can  be  interpreted  geometrically 
in  terms  of  Euler's  theorem:  A  completely  general  angular  displacement 


of  a  rigid  body  can  be  accomplished  by  a  single  rotation  (the  principal 

A 

angle,  4>)  about  a  line  (the  principal  line,  Z)  which  is  fixed  relative 

■A  A  A 

to  both  arbitrary  body-fixed  axes  {b}  and  reference  axes  {n } .  If  (n) 

A 

is  initially  conincident  with  {b},  then  the  direction  cosines  Ui,£2,£3) 

A  A  A 

of  Z  with  respect  to  {n}  and  (b)  are  identical. 

The  Euler  parameters  are  then  related  to  the  principal  rotation 
parameters  as  follows: 

Bo  =  cos  <j>/2 

(2.1) 

3^  =  sin  <p/2,  i  =  1,2,3. 


Note  that  Euler  parameters  satisfy  the  constraint: 

3 

I  05-1.  (2.2) 

i=0 

The  rotation  matrix  [C]  characterizing  the  relationship  between  a  body 

A  AAA 

fixed  frame  { b}  and  a  reference  frame  {n}  by:  {b}  =  [C]{n}  can  be 
written  in  terms  of  Euler  parameters  as: 

Bo  +  3?  -  3l  -  Bi  2(3i32  +  BoB3)  2(BiB3  -  BoB2) 

[C]  =  2(BiB2  -  BoBs)  Bo  -  Bf  +  31  -  Bl  2(B2B3  +  BoBi) 

2(BiB3  +  BoB2)  2(B2B3  -  BoBi )  B§  -  B?  -  Bl  +  Bi 

(2.3) 

2.2  Coordinate  Frames 

For  convenience  we  have  used  several  coordinate  frames  for  Process 
B  and  C  algorithms.  They  are:  the  inertial  frame,  N,  the  gyroscope 
frame,  G,  the  vehicle  frame,  V,  and  two  camera  frames,  A  and  B  (Table 
2.1). 

The  inertial  frame  is  our  primary  reference  frame  and  is  defined, 
essentially,  by  star  positions.  The  locations  of  all  the  stars  in  the 
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Table  2.1 
COORDINATE  FRAMES 

Inertial  Frame  (N):  Primary  reference  frame.  Used  for  star 

positions  and  vehicle  velocity  components. 

Gyroscope  Frame  (G):  Defined  by  orientation  of  three  orthogonal 

gyroscopes.  Rotation  rate  of  the  vehicle 
is  measured  in  this  frame. 

Camera  "A"  Frame  (A):  Defined  by  orientation  of  camera  boresight 

and  focal  plane. 

Camera  "B"  Frame  (B):  Defined  by  orientation  of  camera  boresight 

and  focal  plane. 

Vehicle  Frame  (V):  Defined  by  boresight  unit  vectors  of  the 

"A"  and  "B"  frames.  Orientation  of  this 
frame  with  respect  to  the  "N"  frame  is 
determined  by  Process  B. 

RELATIONSHIPS  BETWEEN  FRAMES 

G  -  N:  Changes  as  vehicle  rotates. 

V  -  N:  Changes  as  vehicle  rotates. 

V  -  G:  Assume  this  varies  slowly  with  time.  Gyro  bias  terms  compen¬ 

sate  for  small,  slow  variations. 

B  -  A:  Assume  this  varies  slowly  with  time.  Interlock  parameters  are 
monitored  by  Process  B. 


onboard  catalog  are  specified  in  this  frame,  as  are  the  vehicle  velocity 
components  (used  for  aberration  corrections).  The  gyro  frame  is  defined 
by  the  axes  of  three  orthogonal  gyroscopes,  fixed  in  the  vehicle.  Each 
gyroscope  gives  a  measure  of  the  vehicle  rotation  rate  about  that  axis 
(these  are  the  rates  integrated  by  Process  C).  Our  simulation  studies 
have  been  configured  for  a  nominally  earth  pointing  spacecraft.  Accordingly, 
we  have  specified  that  the  unit  vectors  {g..}  along  the  gyro  axes  be 
oriented  such  that  g3  is  along  the  radius  vector,  g2  is  perpendicular  to 
the  orbit  plane  and  then  gx  =  g2  *  g3  (nominally  along  the  velocity  vector). 

The  two  camera  frames,  A  and  B,  are  assumed  fixed  to  the  vehicle 
and,  therefore,  maintain  a  fixed  orientation  with  respect  to  the  gyro 
frame.  We  have  specified  that  <a3  and  b3  coincide  with  the  camera  bore- 
sights  and  point  45°  from  the  direction  of  vehicle  motion,  above  and 
below  the  orbit  plane.  Unit  vectors  a_x  and  Jb3  lie  along  the  x  axis  of 
the  CCD  of  each  camera  and  lie  in  the  orbit  plane  while  a_2  and  b2 
form  the  y  axis  of  each  CCD. 

The  V  frame  has  been  defined  by  the  boresight  vectors,  a3  and  b3 
(see  Figure  2.2) : 

Vi  =  (a3  +  b3)/|a3  +  b3| 

v2  =  v 3  x  v3  (2.1 ) 

v3  =  (a3  x  b3)/|a3  x  b3j  . 

Both  Processes  B  and  C  have  been  formulated  to  employ  the  Euler  para¬ 
meters  which  orient  this  vehicle  frame  with  respect  to  the  inertial 
frame. 

There  are  several  advantages  to  this  definition  of  the  V  frame. 

First,  the  boresight  vector  of  each  frame  is  well  determined  compared 


Figure  2.1.  Relationship  of  the  vehicle  frame  to  FOV(A)  and 
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with  the  rotation  about  the  boresight  vector.  Thus,  the  V  frame  orien¬ 
tation  is  not  affected  by  the  poorly  known  quantities.  Second,  by  using 
this  definition  we  weight  frames  A  and  B  equally. 

Although  frames  G,  A  and  B  are  nominally  fixed  with  respect  to  the 
vehicle,  in  reality  these  inteAZock  relative  orientations  will  vary  due 
to  thermal  cycling,  vehicle  vibrations,  etc.  Therefore,  we  have  included 
techniques  in  Processes  B  and  C,  to  be  discussed  in  later  sections,  to 
monitor  and/or  partially  correct  for  these  interlock  variation  effects. 

A  by-product  is  the  attractive  feature  that  the  system  becomes  fully 
self -cal i bra ting. 


t 
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3.0  Process  B 

Attitude  determination  by  processing  image  coordinates  obtained 
from  Process  A  depends  upon  the  ability  to  describe  mathematically  the 
location  of  a  star  image  on  the  CCD  image  plane,  given  its  direction  in 
space  and  the  orientation  of  the  star  tracker.  This  mapping,  a  function 
of  the  Euler  parameters  discussed  in  Section  2,  is  described  by  the 
stellar  colinearity  equations  which,  for  frame  A,  have  the  form: 

LjANji  +  L2AN12  L3AN13 

x  =  f - +  x 

L1AN31  +  L2AN32  +  L3AN33  0 

(3.1) 

L1AN21  +  L2AN22  L3AN23 

y  =  f  - +  y 

L1AN31  +  L2AN32  +  L3AN33  0 

where  f  -  lens  focal  length,  assumed  to  be  constant, 

AN-.  =  elements  of  the  coordinate  frame  rotation  matrix  AN, 

J  in  turn  a  function  of  Euler  parameters,  and 

L.  =  star  direction  cosines  for  the  particular  star  as 
measured  in  the  N  frame 

(Vy0)  =  principal  point  offsets. 

If  there  are  several  stars  in  a  single  field  of  view  (FOV)  we  seek 
to  minimize  the  sum  of  the  squares  of  the  residuals  between  measured 
star  images  and  predicted  coordinates  for  the  same  stars.  This  is 
accomplished  by  adjusting  the  Euler  parameters,  which  orient  the  star 
tracker  frame,  using  a  least-square  differential  correction  scheme. 

Before  outlining  the  least-square  procedures,  we  describe  the 
process  of  equating  particular  catalog  stars  with  measured  stars.  To 
start  Process  B  we  need  an  estimate  of  the  camera  orientation.  This  can 
be  provided  by  either  the  results  of  a  previous  pass  through  Processes  B 
and  C  or  from  some  indirect  method  such  as  horizon  sensors.  This 
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estimate  is  needed  to  acquire  a  "sub-catalog"  from  the  mission  catalog 
and  must  be  sufficiently  accurate  so  that  the  subcatalog  contains  the 
measured  stars. 

3.1  Star  Catalog 

As  part  of  our  work  on  Process  B,  we  have  converted  the  visual 
magnitude  of  over  5,000  stars  to  a  standard  infra-red  (I)  magnitude. 

For  simplicity,  we  assumed  the  instrument  magnitude  is  identical  to 
the  I  magnitude  (which  could  be  arranged  by  using  an  I  filter).  In 
specific  applications  instrument  magnitude  would  probably  be  based 
upon  laboratory  calibration.  We  have  not  precessed  the  star  positions 
nor  corrected  for  proper  motion  since  these  tasks  would  best  await  an 
actual  flight  test  of  the  system.  Details  of  magnitude  conversions 
are  discussed  in  Appendix  2. 

In  addition,  we  developed  a  star  catalog  format  for  easy  access. 

The  celestial  sphere  is  divided  into  cells  or  segments  in  an  orderly 
pattern  so  that  any  cell  can  be  accessed  easily  to  obtain  the  positions 
of  stars  contained  within.  It  is  important  to  keep  in  mind  that  our 
catalog  segmentation  and  access  logic  were  designed  for  a  general  mis¬ 
sion.  Simplified  catalogs  could  be  designed  for  specific  missions.  See 
Appendix  3  for  more  details  on  the  cell  structure  and  access  logic. 

3.2  Star  Pairing 

Associating  catalog  and  measured  stars  begins  by  sorting  catalog 
stars  by  angular  distance  off  the  apriori  estimated  FOV  boresight 
direction.  By  computing  the  vector  dot  product  of  each  star  with  the 
boresight  vector  we  have  a  suitable  measure  of  angular  distance  and  can 
sort  stars  according  to  this  parameter  (and  thereby  avoid  repetative 


angle  calculations  from  inverse  trigonometric  functions).  The  next  step 
is  to  compute  and  store  in  a  table,  the  cosine  of  the  interstar  angle 
for  all  possible  pairs  of  measured  stars.  We  then  pair  catalog  stars, 
beginning  with  stars  nearest  the  estimated  boresight,  compute  the  cosine 
of  the  interstar  angle,  and  then  compare  this  value  with  each  value  for 
the  measured  pairs  (refer  to  Appendix  4).  This  process  is  repeated 
until  either  a  match  is  found  to  within  some  tolerance  or  the  list  of 
catalog  stars  is  exhausted.  In  the  latter  case  we  start  over  with  fresh 
data  from  Process  A  and  a  new  estimate  of  orientation.  However,  if  a 
match  is  found,  we  tentatively  assume  the  catalog  pair  is  the  same  as 
the  measured  pair.  We  are  now  ready  to  adjust  the  estimated  orientation 
parameters  via  least-squares  correction  to  get  the  two  projected  catalog 
stars  to  overlay  the  two  measured  stars.  Because  of  the  relatively  high 
probability  of  finding  an  invalid  star  pair  match,  attitude  confirmation 
requires  additional  star  matches,  as  discussed  below.  We  must  also 
account  for  the  effect  of  stellar  aberration  on  the  star  direction 
cosines  (refer  to  Appendix  5). 

3.3  Least-Squares  Correction 

The  non-linear  relationship  between  the  Euler  parameters  and  star 
image  coordinates  requires  an  iterative  least-squares  correction  proce¬ 
dure  to  find  the  best  estimate  of  vehicle  orientation.  Basically,  at 
each  iteration  we  require  the  Euler  parameter  corrections  to  minimize: 

(AX  -  A  AB)TW(AX  -  A  AB)  (3.2) 

where  AX  is  a  column  vector  of  x  and  y  coordinate  residuals  between  the 
measured  and  predicted  images  (using  the  current  values  for  the  orienta¬ 
tion  variables),  A  is  a  matrix  of  partial  derivatives  of  star  positions 
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(the  stellar  colinearity  equations)  with  respect  to  current  Euler  parameters, 

AB  is  the  correction  vector  to  be  added  to  the  current  parameters  and  W 
is  a  weight  matrix.  The  derivation  of  this  equation  is  found  in  Appendix 
6. 

Since  the  Euler  parameters  must  satisfy  a  constraint  equation,  it 
is  necessary  to  guarentee  that  the  corrected  Euler  parameters  also 
satisfy  this  constraint.  If  we  express  the  constraint  equation  as 

f3T  6  *  1,  (3.3) 

then,  after  correcting  the  parameters,  the  corrections  AB  must  satisfy: 

(B  +  AB)T  (B  +  AS)  =  1.  (3.4) 

Expanding  to  first  order  we  have: 

BT  B  +  2BT  AB  =  1  +  residual  (3.5) 

and  by  writing  this  as 

(1  -  6TB)  -  2BTAB  =  residual  (3.6) 

we  can  append  1  -  B^B  to  the  AX  vector,  2BT  to  the  A  matrix  and  AB  is 
again  the  correction  vector.  In  solving  Eq.  (3.2)  we  assign  a  large 
weight  to  this  constraint  equation  in  order  to  insure  that  it  is  satis¬ 
fied  (>.e.,  the  residual  will  be  essentially  zero). 

After  the  vector  of  Euler  parameters  has  been  found  by  iteration, 
it  is  necessary  to  confirm  whether  or  not  the  catalog  pair  is  indeed  the 
measured  pair  (i.e.,  whether  we  have  the  correct  orientation).  Each 
catalog  star  is  mathematically  projected  onto  the  focal  plane  and  tested 
to  see  if  it  lies  near  a  measured  star.  A  match  of  three  or  more  stars 
is  considered  a  positive  outcome;  a  match  of  only  two  stars  (most  likely 
the  Initial  pair)  or  fewer  constitutes  failure  and  we  continue  with  star 
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pair  matching  to  find  another  pair.  In  the  present  software  version  we 
accept  up  to  5  catalog  stars  which  match  measured  stars  in  one  FOV. 

The  star  pair  matching  and  confirmation  calculations  described 
above  are  performed  separately  for  each  FOV.  If  the  outcome  for  each 
FOV  is  positive,  we  have  up  to  5  measured  stars  from  each  FOV  with  their 
corresponding  catalog  positions.  All  of  these  stars  are  used  to  correct 
the  orientation  again  and,  in  addition,  to  correct  the  Euler  parameters 
defining  the  interlock  relationship  between  the  two  FOV.  We  again 
minimize: 

(AX  -  A  A3)TW(AX  -  AA6). 

Now,  AX  contains  the  residuals  for  all  images,  the  A  matrix  contains 
partial  derivatives  with  respect  to  both  the  Euler  parameters  orienting 
the  vehicle  frame  and  those  orienting  frame  B  with  respect  to  A,  and  A3 
contains  corrections  to  these  same  Euler  parameters.  As  before,  we 
append  two  constraint  equations,  one  for  each  set  of  Euler  parameters, 
to  the  matrix  equation.  (Refer  to  Appendix  7  for  details  of  this  pro¬ 
cedure). 

This  method  yields  an  accurate  3yN  vector  compared  with  3BA-  The 
3vn  describe  the  orientation  of  the  vehicle  frame  which,  in  turn, 
is  determined  by  the  FOV  bores ight  vectors,  both  usually  well  deter¬ 
mined.  On  the  other  hand,  the  3BA  are  effected  by  the  relatively  poorer 
determination  of  the  roll  angle  about  the  boresight  vector  of  each  FOV. 
Therefore,  we  have  found  it  desirable  to  further  process  3BA-  We  assume' 
the  true  3BA  vary  slowly  (due  to  such  things  as  thermal  cycling)  and 
write: 

-  0  (3.7) 

and  then  combine  the  apriori  or  predicted  values  of  3gA  (obtained  from  a 
previous  analysis)  with  the  calculated  values  of  3gA  obtained  via 


least-squares.  The  two  vectors  of  gg^  are  combined  using  a  discrete 
Kalman  filter  (see  Appendix  6  for  details).  This  method  can  be  used, 
with  proper  tuning,  to  monitor  the  interlock  variations  and  give  the 
system  "memory"  of  past  interlock  determinations. 

We  note  that  the  least-squares  method  for  two  FOV  and  the  Kalman 
filter  calculations  involve  considerable  mathematics,  such  as  matrix 
multiplication  and  matrix  inversion,  which  adversely  affects  execution 
time.  However,  it  is  important,  we  feel,  to  provide  the  option  to 
calibrate  (as  often  as  necessary)  the  interlocks  between  camera  frames. 
By  monitoring  these  variations  we  can  make  the  system  self-calibrating 
and  can  tolerate  modest  lack  of  mechanical  stability  in  the  various 
interlocks. 
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4.0  Process  C 

Procsss  C  software  has  two  primary  functions:  (1)  integrate  the 
kinematic  differential  equations  describing  the  satellite  motion  over  a 
short  time  interval  in  order  to  provide  Process  B  with  a  new  attitude 
estimate,  and  (2)  combine  this  integrated  orientation  with  the  orien¬ 
tation  determined  by  least-squares  in  Process  B.  The  second  function  is 
performed  via  a  discrete  Kalman  filter  to  yield  an  optimal  estimate  of 
the  orientation  at  a  particular  time. 


4.1  Kinematic  Equations 


The  differential  equations  describing  the  kinematics  of  a  rotating 
coordinate  frame  with  respect  to  a  fixed  frame,  expressed  in  terms  of 
Euler  parameters,  are: 
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where  {£}  are  the  Euler  parameters  orienting  the  frame  and  {o)}  are  the 
gyro  rates  measured  in  that  frame,  along  the  3  orthogonal  axes. 


In  our  model  we  prefer  to  use  the  Euler  parameters  orienting  the 
vehicle  frame,  V,  with  respect  to  the  inertial  frame,  N.  Therefore,  the 


23 


gyro  rates,  measured  in  the  G  frame,  must  be  transformed  into  the  V 
frame  via  matrix  VG,  which  we  assume  to  be  constant.  In  addition,  the 
measured  gyro  rates,  {to},  contain  noise  terms  and  other  effects  such  as 
errors  due  to  nonorthogonality  of  the  gyroscopes,  variations  in  the  V-G 
interlocks,  and  gravity  or  magnetic  effects.  We  account  for  these 
effects,  to  first  order,  by  absorbing  all  except  gyro  noise  into  ban> 
terms,  {b},  one  per  axis.  The  equations  become  (using  letter  subscripts 
to  denote  the  appropriate  coordinate  frame  relationships): 

(PVN^  =  ^BVN^VG-*tu)GN  "  bGN* 

=  "  t^\/m^t-VG]{bg^} 

where  {aiGN>  =  {^GN>(true)  +  (bGN>  +  {noise}.  The  gyro  biases  are 
assumed  to  be  slowly  varying;  this  allows  us  to  write: 


which  is  valid  over  short  time  intervals.  The  set  of  seven  differential 
equations  (for  the  four  Euler  parameters  and  three  biases)  can  be 
integrated  via  Runge-Kutta  methods  to  yield  a  new  orientation  estimate 
for  Process  B. 

4.2  Kalman  Filter  Equations 

The  two  estimates  of  vehicle  attitude,  one  from  integration  of  the 
kinematic  equations  and  the  second  from  Process  B  attitude  estimation, 
are  combined  to  give  a  best  estimate  of  the  attitude.  We  have  adopted 
the  discrete  Kalman  filter  equations  for  a  linear  system: 
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Xk+1(k  +  1)  =  Xk(k  +  1)  +  K(k  +  1 ){Y(k  +  1)  -  Y(k  +  1)} 

Pk(k  +  1)  =  Pk(k)  +  /tk+1  P  dt  (4.5a-d) 

tk 

S-1 

Ly  y  +  H(k  +  l)P.(k  +  1  )HT(  k  +  1) 
vk+l vk+l  K 

pk+i ( k  +  l>  -  Cl  -  K(k  +  l)H(k  +  l)]Pk(k  +  ?) 

where 

A 

Xk+1(k  +  1)  =  optimal  estimate  of  the  state  X  at  time  tk+-|  based  on 
k  +  1  data  sets, 

Xk(k  +1)  =  state  X  at  time  tk+l  based  on  k  data  sets,  and  calculated 

from  forward  integration  of  kinematic  equations, 

K(k  +  1)  =  Kalman  gain  matrix  for  time  tk+1. 


Y(k  +  1) 

Y(k  +  1) 
Pi(j) 

H(k  +  1 ) 


=  Values  of  3VN  from  Process  B  and  bias  values 
from  previous  iteration. 


c--|  =  Values  of  3WW  from  integration  and  bias 

dGN\  vn 

values  from  previous  iteration. 


=7x7  covariance  matrix  at  time  t,  based  on  i  data 

J 

sets. 


=  371  =  I  (for  our  case), 

dX  |  x 

Vi 


Lu  „  =  covariance  matrix  associated  with  measurement  of  the 

vk+lvk+l 

state  (or  observations)  from  Process  B  (the  upper  left 
4x4)  and  covariance  for  the  biases  (the  lower  right 


3x3),  and 

=  integration  of  the  matrix  Riccati  equation  for 
covariance  propagation  (see  Appendix  8). 


A 
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Notice  that  we  have  included  the  biases  as  observables  in  our 
Kalman  filter  equations.  By  choosing  the  appropriate  covariance  values 
in  matrix  L  and  P,  we  can  control  the  corrections  to  the  biases.  We 
have  done  this  because  we  hypothosize  that  the  biases  vary  slowly— or  at 
least  the  effects  which  we  are  most  interested  in  monitoring  vary 
slowly.  Our  simulation  tests  indicate  that  with  this  formulation  we  can 
follow  the  bias  terms  added  to  the  rate  gyro  data  and  absorb  variations 
in  the  interlock  matrix  VG  into  the  bias  terms  with  little  degradation 
in  the  optimal  state  estimate. 
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5.0  Truth  Model  and  Simulation  Tests 

The  algorithms  for  Process  B  and  C  were  tested  by  processing  data 
produced  by  a  simulation  program  ("truth  model")  and  then  comparing  the 
results  with  the  “true"  model.  Each  test  consisted  of  processing  a 
series  of  29  data  frames  separated  by  30  seconds  of  satellite  motion. 

The  most  important  input  data  are  the  image  coordinates  and  intensities 
of  the  stars  in  each  field  of  view  from  Process  A  and  the  most  important 
output  data  are  the  calculated  orientation  from  Processes  B  and  C.  The 
simulation  program  was  written  to  include  variations  in  several  impor¬ 
tant  parameters  such  as  Euler  parameters  describing  the  relative  orien¬ 
tation  of  the  two  camera  frames,  Euler  parameters  for  the  rotation  from 
the  gyro  to  vehicle  frames,  and  gyro  bias  terms.  To  illustrate  the 
performance  of  our  algorithms  for  this  report  each  series  included  the 
parameter  variations  of  the  previous  model  plus  only  one  additional 
parameter  variation. 

5.1  Simulation  Program 

We  first  describe  briefly  the  creation  of  simulated  data.  The 
first  step  is  to  choose  an  appropriate  satellite  orbit,  specified  by  its 
semimajor  axis,  orbital  period  and  inclination.  To  facilitate  the 
calculation  of  satellite  position  and  velocity,  we  make  use  of  Herrick's 
two  body  solution  (see  Ref.  6,  p.  155).  To  use  this  method  we  specify 
the  initial  position  and  velocity  components,  expressed  in  the  inertial 
frame,  and  the  associated  time.  All  later  positions  and  velocities  can 
be  determined  by  specifying  the  desired  time  and  solving  several  equations. 
This  same  method  is  used  to  determine  the  earth's  position  and  velocity 
at  each  time  step.  Velocity  data  are  needed  to  calculate  the  aberration 
of  starlight  which  affects  the  apparent  star  directions. 
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All  of  our  tests  have  assumed  a  circular  satellite  orbit  and  a 
nominally  earth  pointing  vehicle.  To  reflect  this  choice  we  initially 
orient  the  gyroscope  frame  so  that  the  g 2  axis  is  perpendicular  to  the 
orbit  plane  and  the  primary  vehicle  rotation  is  about  that  axis.  The  g3 
axis  is  initially  along  the  orbit  radius  vector,  r.»  and  £1  is  given  by 
£2  *  £3.  Since  our  primary  orientation  variables  are  By^,  as  discussed 
in  Section  2,  we  obtain  their  initial  values  as  follows:  specify  the 
initial  values  for  Byg  and  calculate  the  rotation  matrix  VG,  then  use 
the  gyro  unit  vectors  {£}  to  fill  matrix  GN  and  calculate  VN  =  VG  •  GN; 
3VN  can  then  be  recovered  from  VN.  All  subsequent  values  of  3yN  are 
obtained  by  integrating  the  kinematic  differential  equations  forward  in 
time.  The  gyroscope  rate  history,  needed  for  the  integration,  is  given 
for  the  G  frame;  therefore,  the  rates  are  rotated  into  the  V  frame  by 
matrix  VG,  a  function  of  Byg,  which  can  be  either  constant  or  time 
varying.  See  Appendix  9  for  details  of  rate  gyro  data  simulation. 

At  each  time  step  we  calculate  the  VN  matrix  from  By^.  Matrix  BA 
is  computed  from  Bg^  (again,  constant  or  time  varying  parameters)  and 
from  BA  we  compute  AV  (see  Appendix  7).  The  last  row  of  AN  =  AV  •  VN  is 
the  FOV(A)  camera  boresight  unit  vector,  needed  to  access  the  star 
catalog  for  a  subcatalog  of  stars.  After  adding  the  effects  of  aber¬ 
ration,  the  stars  are  projected  onto  the  CCD  image  plane  via  the  stellar 
colinearity  equations.  Stars  seen  by  the  second  camera  are  obtained  in 
the  same  manner,  after  first  computing  BN  =  BA  •  AN  to  get  the  boresight 
unit  vector. 

The  Image  coordinates  obtained  by  the  above  methods  are  assumed  to 
represent  the  "true"  state.  In  an  actual  system  Process  A  will  not, 
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of  course,  produce  the  true  image  coordinates.  Me  have  assumed  that  the 
centroiding  of  an  image  can  be  performed  to  an  accuracy  of  10%  of  a 
pixel  (1-sigma  error)  and  that  systematic  errors  such  as  image  distortion 
can  be  accounted  for  and  removed.  Therefore,  we  perturb  the  true  image 
coordinates  with  Gaussian  noise. 

Various  data  are  stored  on  tape  or  disk  for  later  analysis  by 
Process  B  and  C.  Space  is  left  at  the  end  of  each  record  (one  record 
per  frame)  for  data  computed  by  Processes  B  and  C;  these  are  later 
analyzed  for  accuracy  and  displayed. 

5.2  Simulation  Tests 

A  set  of  eight  models  was  used  to  test  our  algorithms.  All  models 
followed  the  same  orbital  path  and  rotation  history.  Of  the  29  data 
frames,  each  consisting  of  image  coordinates  in  a  pair  of  FOV  and 
separated  by  30  seconds  of  flight  time,  only  once  does  a  FOV  contain 
2  stars  (the  case  at  8  minutes  from  the  start).  In  that  case,  the 
least-squares  solution  used  only  the  stars  from  one  FOV;  the  orientation 
errors  for  this  case  are  relatively  large  in  all  models.  For  display 
purposes,  we  have  plotted  the  root-mean-square  of  the  angular  errors 
between  the  calculated  and  true  vehicle  frame  (using  the  1-2-3  Euler 
angle  set).  There  are  actually  three  calculated  frames:  the  result 
of  Process  B  least-squares,  the  integrated  state,  and  the  optimal 
estimate  from  the  Kalman  filter.  Each  series  started  with  an  estimate 
about  2  degrees  in  error.  Thus,  several  frames  must  be  processed  for 
the  system  to  reach  steady  state. 

No  noise  or  parameter  variations  were  included  in  the  first 
model  in  order  to  verify  that  the  software  could  indeed  recover  the 
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true  state  (Figure  5.1).  Gaussian  noise  added  to  the  rate  gyro  data  (1 
sigma  =  1  arcsecond/ second)  causes  the  integrated  state  of  our  second 
model  to  deviate  from  the  true  state  (Figure  5.2).  It  is  evident  that 
with  this  level  of  noise,  the  state  could  be  integrated  several  minutes, 
at  least,  before  the  accumulated  error  would  place  the  estimated  state 
too  far  from  the  true  state.  Thus,  Process  C  provides  adequate  backup 
for  failures  of  Process  B.  Notice  also  that  the  optimal  estimate  nearly 
matches  the  Process  B  state;  this  is  due  to  the  significantly  smaller 
covariance  associated  with  the  Process  B  result. 

Our  third  test  included  noise  in  the  image  coordinates  (1  sigma  = 
0.0034  mm)  corresponding  to  approximately  10  arcsecond  error  in  deter¬ 
mining  a  star's  direction  (lens  focal  length  =  70  mm).  Once  again  the 
optimal  estimate  is  nearly  the  Process  B  result  (Figure  5.3).  This  and 
all  following  simulation  models  show  that  the  most  important  factor 
affecting  the  vehicle  attitude  determination  accuracy  is  the  accuracy 
with  which  individual  star  centroids  can  be  determined.  A  reduction  of 
centroid  errors  will  produce  a  proportional  reduction  in  orientation 
errors.  Since  the  least-squares  result  nearly  matches  the  optimal 
estimate,  improving  the  star  tracker  performance  will  yield  the  most 
improvement  in  attitude  estimation.  Our  choice  of  10%  pixel  centroiding 
error  for  each  star,  yielding  about  5  arcsecond  vehicle  pointing  error, 
is  considered  conservative.  Indications  are  that  5%  pixel  error  can  be 
obtained  routinely,  with  perhaps  even  smaller  errors  for  brighter  stars 
(considerable  research  is  presently  under  way  to  determine  optimal  "tuning" 
of  the  sensor  and  centroiding  process-cl early  an  appropriate  scale  factor 
can  be  applied  to  our  results  to  reflect  other  centroiding  error  models). 
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The  fourth  model  included  variations  in  the  Euler  parameters 
describing  the  interlock  between  star  tracker  frames.  As  expected,  this 
does  not  seriously  degrade  the  orientation  of  the  vehicle  (V)  frame 
since  its  orientation  is  defined  by  the  boresight  unit  vectors  (Figure 
5.4a).  It  will  be  recalled  that  Process  B  algorithms  estimate  these 
interlock  parameters.  Figures  5.4b-d  display  the  estimates  obtained 
for  the  three  interlock  angles.  Each  figure  shows  the  deviations,  from 
the  nominal  interlock  angle,  of  the  true  angle,  the  angle  calculated 
from  least-squares  and  the  best  estimate  of  the  interlock  angle.  This 
series  used  a  value  5  arcseconds  for  the  variance  of  process  noise 
matrix  in  the  Kalman  filter  calculations.  The  fifth  series  was  identical 
to  the  forth  series  except  we  used  a  value  of  10  arcseconds.  Results  of 
Figure  5.5a  indicate  little  effect  on  the  vehicle  frame  orientation 
while  Figures  5.5b-d  show  improved  interlock  recovery  compared  with 
Figure  5.4b-d.  The  value  used  for  the  process  noise  should  be  influ¬ 
enced  by  the  size  of  the  expected  variations  in  interlocks.  A  strict 
value  (small  noise)  prohibits  the  algorithm  from  following  a  true 
variation  while  a  large  value  leads  to  large  fluctuations  in  the  inter¬ 
locks  and  no  meaningful  self-calibration. 

The  next  several  simulations  concern  Process  C  performance.  First 
we  added  a  time  varying  bias  term  to  each  gyro  axis  in  order  to  test  how 
well  Process  C  algorithms  recover  and  follow  each  bias.  Figure  5.6a 
indicates  the  biases  degrade  the  integrated  state  only  slightly  once 
the  biases  have  been  recovered  (after  several  minutes).  Figure  5.6b 
shows  the  true  and  calculated  bias  values.  By  choosing  a  different 
value  for  the  bias  variance  (see  Section  4)  we  can  control  the  fluctua¬ 
tions  in  the  recovered  biases.  To  demonstrate  this,  in  our  seventh 


series  we  increased  the  variance  square  root  from  0.5  to  1.0  arcsecond/ 
second.  Figure  5.7a  shows  no  effect  on  the  vehicle  frame  determination 
while  Figure  5.7b  indicates  a  faster  bias  recovery  but  somewhat  larger 
bias  fluctuations  compared  with  Figure  5.6b. 

Our  final  simulation  test  included  the  effects  of  time-varying 
and  off-set  Euler  parameters,  &Vq,  describing  the  relationship  between 
the  vehicle  and  gyro  frames.  Process  C  algorithms  assume  this  relation¬ 
ship  is  fixed  (in  our  case  rotation  matrix  VG  is  the  identity  matrix)  so 
any  deviation  will  appear,  over  the  short  interval,  as  simply  an  addi¬ 
tional  bias  term  in  the  gyroscopes.  Thus,  we  see  little  effect  in  the  V 
frame  errors  (Figure  5.8a)  but  notice  the  recovered  bias  values  are 
displaced  somewhat  from  their  previous  tracks  (Figure  5.8b,  variance 
square-root  is  0.5  arcsecond/second).  We  assume  that  other  slowly 
varying  or  constant  effects  will  be  accounted  for  in  like  manner. 

The  choice  for  the  bias  variance  should  be  influenced  by  the 
expected  variations  in  the  gyro  biases  as  well  as  an  estimate  of  vari¬ 
ations  in  other  elements.  As  with  the  FOV  interlock  weight,  a  strict 
value  (small  variance)  restricts  the  tracking  of  a  true  variation  while 
a  liberal  value  negates  the  self-calibrating  nature  of  the  algorithms. 


RNGULRR  ERRORS  IN  ORIENTATION 


Orientation  errors  of  vehicle  frame  for  simulati 
rate  gyro  errors  and  no  image  centroid  errors. 


RNGULRR  ERRORS  IN  ORIENTATION 


Orientation  errors  of  vehicle  frame  for  simulation  test  with 
noise  added  to  rate  tyro  data,  (a  =  1  arc  sec/second). 
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Figure  5.3:  Orientation  errors  of  vehicle  frame  for  simulation  test  with 
image  centroid  errors,  (a  =  0.0034  mm). 
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Orientation  errors  of  vehicle  frame  for  simulation  test 
with  time  varying  interlock  angles  between  camera  frames 
(process  noise  =  5  arcseconds) 
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(D3S0dU)  SN0I1UIA3Q  dUinONU 


Deviations  of  the  first  Euler  angle  (3-1-3  set)  from  the  nominal 
value  (0°):-=  true  angle,  +  =  least-squares  estimate,  *  = 

Kalman  filter  estimate. 
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DEVIATIONS  OF  INTERLOCK  ANGLES  FROM  NOMINAL 
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Deviations  of  the  first  Euler  angle  (3-1-3  set)  from  the  nominal 
value  (0°):  =  true  angle,  +  =  least-squares  estimate,  *  = 

Kalman  filter  estimate. 
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Figure  5.5c:  Deviation  of  the  second  Euler  angle  (3-1-3  set)  from  the  nominal 
value  (90°) :  -  =  true  angle,  +  =  least-squares  estimate,  *  = 
Kalman  filter  estimate. 
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Figure  5.5d:  Deviation  of  the  third  Euler  angle  (3-1-3  set)  from  the  nominal 
value  (0°):  -  =  true  angle,  +  =  least-squares  estimate,  *  = 
Kalman  filter  estimate. 


Figure  5.6a:  Orientation  errors  of  vehicle  frame  for  simulation  test  with  time 
varying  gyro  bias  terms. 
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BIAS  RECOVERY  TEST  OF  PROCESS  C 


Figure  5.8a:  Orientation  errors  of  vehicle  frame  for  simulation  test  with  time 
varying  interlock  angles  between  the  gyro  and  vehicle  frame. 


BIRS  RECOVERY  TEST  OF  PROCESS  C 
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6.0  Conclusions 

The  simulations  discussed  in  Section  5  illustrate  that  our  algorithms 
can  routinely  yield  5  arcsecond  accuracy  for  the  assumed  star  tracker 
configuration  and  using  up  to  5  stars  in  each  field  of  view.  There  will 
be  occasional  errors  greater  than  5  arcseconds  because  of  too  few  stars 
in  one  or  both  FOV.  Therefore,  we  consider  our  quoted  accuracy  to 
represent  a  one  sigma  error. 

We  have  not  demonstrated  explicitly  that  the  necessary  calculations 
can  be  carried  out  rapidly  enough  to  yield  a  new  attitude  estimate  every 
30  seconds,  as  planned.  However,  this  can  be  accomplished,  we  believe, 
simply  by  converting  our  algorithms  from  an  interpreter  to  compiler  type 
of  computer  language.  Such  a  change  would  probably  reduce  computer  time 
by  a  factor  of  5  to  10  (from  roughly  60  seconds  per  frame  to  less  than 
12  seconds). 

There  are  several  features  of  our  algorithms  which  need  special 
emphasis.  First,  it  is  important  to  keep  in  mind  that  our  algorithms 
assume  a  slowly  rotating  satellite.  Our  algorithms  are  designed  to 
determine  the  vehicle  attitude  provided  there  is  an  attitude  estimate 
which  is  within,  say,  5-10  degrees  of  the  truth.  In  a  steady-state 
mode,  we  can  integrate  rate-gyro  data  between  successive  frames  and 
thereby  provide  sequential  estimates.  However,  there  must  be  some 
system  such  as  horizon  sensors  to  provide  a  rough  attitude  estimate 
either  in  case  of  start-up,  after  vehicle  maneuvers,  and  perhaps  after 
successive  failures  of  Process  B. 

Also,  several  parameters  must  be  chooser  after  a  real  system  is 
designed  or  assembled.  Two  of  these  are  the  variance  for  the  Kalman 
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filter  interlock  estimation  and  the  gyro  bias  variance  for  the  Kalman 
filter  bias  estimation;  both  of  these  are  important  for  the  self-cali¬ 
brating  features  of  our  algorithms.  We  have  not  attempted  to  provide 
the  extensive  error  checking  capability  needed  on  a  flight  system  since 
it  is  impossible  to  foresee  the  many  types  of  failures  or  errors  encoun¬ 
tered  in  a  real-life  situation. 

There  are,  of  course,  many  possible  modifications  and  additions 
which  could  be  made.  One  obvious  modification  is  to  reduce  the  number 
of  stars  used  in  the  least-squares  correction  from  the  current  5  to 
perhaps  3  or  4  per  FOV.  Obviously,  this  will  reduce  the  attitude  accuracy 
but  would  have  the  advantage  of  reducing  computing  time  and  memory 
requirements.  Perhaps  with  some  additional  logic  the  3  or  4  stars  most 
widely  distributed  over  the  FOV  could  be  selected  and  thereby  lessen  the 
impact  of  fewer  stars.  An  improvement  in  attitude  estimation  could  be 
obtained  by  using  a  longer  focal  length  lens  for  each  star  tracker. 

This  reduces  the  pointing  error  to  each  star  due  to  centroiding  errors 
and  therefore  improves  orientation  estimates.  However,  such  a  change 
reduces  the  field  of  view  and  the  number  of  stars  detected  (unless  a 
larger  lens  is  used  to  detect  fainter  stars,  requiring  a  larger  catalog 
as  well). 
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Appendix  1 ;  CCD  Star  Tracker 

An  important  element  of  the  attitude  determination  system  discussed 
in  this  report  Is  the  CCD  star  tracker.  In  this  appendix  we  discuss 
some  of  the  key  features  of  such  a  star  tracker. 

A  CCD  array  has  a  high  degree  of  dimensional  stability  and  is 
relatively  immune  to  magnetic  effects.  These  features  make  it  very 
attractive  for  a  star  tracker.  For  a  general  purpose  tracker  the  field 
size  is  typically  5°  to  10°  wide  and  with  CCD  array  sizes  currently 
available,  the  star  images  would  be  a  fraction  of  a  pixel  in  diameter. 

By  defocusing  the  camera  lens  slightly  so  a  typical  image  covers  a  3  * 

3  array  of  pixels  an  image  centroid  can  be  computed  with  at  least  10% 
pixel  accuracy.  By  applying  a  stored  correction  function,  this  error 
can  be  reduced  still  further. 

Two  other  factors  affecting  centroid  accuracy  are  pixel  response 
variations  and  photon  noise.  Response  variations  can  be  corrected  via 
a-priori  calibration.  However,  due  to  time  and  computer  memory  limita¬ 
tions  only  the  most  severe  variations  would  be  corrected  in  practice. 
Cooling  the  CCD  reduces  thermal  noise  but  the  photon  noise  is  always 
present,  affecting  fainter  images  more  than  brighter  images.  It  is 
expected  that  a  star  tracker  with  sophisticated  software  could  determine 
centroids  with  an  accuracy  of  5%  of  a  pixel  (la)  for  minimum  brightness 
stars  and  perhaps  2-3%  error  for  the  brightest  stars. 

To  prevent  the  star  images  from  smearing  on  the  CCD  due  to  vehicle 
motion,  the  expoMiAe  time  or  integration  time  must  be  kept  short.  On 
the  other  hand,  the  analog  voltage  response  from  star  illuminated  pixels 
must  be  accurately  converted  to  a  digital  value,  a  relatively  slow 
process.  Several  techniques  can  be  employed  to  improve  read  out  speed. 
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The  first  is  to  trigger  the  analog  to  digital  (A/D)  conversion  only  for 
preselected  pixels  or  those  that  exceed  a  minimum  threshold.  Preselec¬ 
tion  can  be  done  after  a  set  of  stars  has  been  located  from  the  previous 
frames,  while  the  triggering  method  can  be  instituted  in  a  search  mode. 

A  second  speed  gain  can  be  achieved  by  line-skipping— skipping  the  read¬ 
out  of  rows  of  pixel  responses  after  they  have  been  transferred  from 
vertical  registers  into  the  horizontal  register.  This  technique  can  be 
employed  in  the  traak  mode  once  a  set  of  stars  has  been  located. 

We  anticipate  that  Process  A  will  be  able  to  received  multiple 
frames  of  data  from  the  star  trackers  before  Process  B  is  ready  to 
accept  new  data.  This  may  allow  Process  A  time  to  edit  the  data  such  as 
predicting,  crudely,  where  the  stars  may  appear  in  the  next  frame 
and/or  providing  Process  B  with  some  average  position  for  each  star  in  a 
frame.  This  latter  technique  could  improve  the  projected  accuracy  by 
averaging  out  some  random  position  errors. 
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Appendix  2:  CCD  Instrument  Response  and  Stellar  Magnitude  Conversion 


As  mentioned  in  Section  1,  the  outputs  of  Process  A  are  the  inter¬ 
polated  centroids  and  instrument  magnitudes  for  each  valid  star  image. 
The  purpose  of  this  Appendix  is  the  discussion  of  the  approximate  tech¬ 
niques  utilized  in  the  synthesis  of  these  two  outputs. 

A2.1  The  Star  Centroids 

The  centroid  location  (*c,yc)  is  given  by 
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where  R^  is  the  A/D  converted  response  level  of  the  pixel  located  at 
(x.j»y.j)  and  the  summations  are  over  the  square  array  of  pixels  illuminated 
by  the  defocused  star  image  (9  to  16  pixels). 

Typical  cell  size  for  a  CCD  is  approximately  0.030  mm  on  a  side. 

A  CCD  placed  behind  a  70  mm  focal  length  lens  (proposed  for  one  CCD 
star-sensor)  gives  a  resolution  of  approximately  1.5  arc -minutes  for  a 
focused  image.  When  apread  over  a  3  x  3  or  4  x  4  cell  pattern,  the 
resolution  with  which  the  centroid  can  be  located  has  been  found  to  be 
_<  6  arc-sec.  For  double  stars.  Process  A  would  produce  image  coordinates 
for  a  single  star  but  with  poorly  determined  image  coordinates  (a  weighted 
mean  of  the  two  stars). 

Detections  of  double  stars  should  not  be  used  in  Process  B  since 
they  would  result  in  poor  orientations.  One  solution  to  this  problem 
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is  to  delete  from  the  mission  catalog  all  star  pairs  with  separations 
less  than  some  tolerance  (~6  arc-min.  in  this  case).  There  are  sufficient 
stars  in  the  catalog  that  this  deletion  should  not  seriously  degrade 
performance.  Some  additional  time  in  Process  B  will  be  used  trying 
unsuccessfully  to  pair  measured  double  stars  with  catalog  stars,  but 
since  detection  of  double  stars  will  be  a  relatively  rare  event,  this 
time  penalty  should  not  be  a  significant  practical  problem. 

A2.2  CCD  Magnitude  Response 

A2.2.1  Magnitude  Conversion 

Due  to  both  the  different  spectral  qualities  of  various  stars  and 
the  peculiarities  in  the  unfiltered  CCD  response  (the  primary  sensitivity 
is  to  red  or  near  infra-red  radiation)  two  stars  of  the  same  visual  (V) 
magnitude  (for  example)  may  cause  different  CCD  response.  Hence  none 
of  the  cataloged  star  magnitudes  may  be  used  directly.  Rather,  the 
magnitudes  of  the  stars  must  be  properly  transformed  (using  the  spectral 
properties  contained  in  the  master  star  catalog  SKYMAP)  prior  to  inser¬ 
tion  in  the  mission  catalog.  Simply  stated,  the  mission  catalog  must 
contain  an  "instrument  magnitude"  for  each  star. 

It  has  been  decided  to  convert  the  V  magnitudes  of  SKYMAP  to  I 
magnitudes  and  utilize  an  I  filter  placed  over  the  CCD  array.  The 
following  points  support  this  decision: 

(1)  Given  the  information  in  SKYMAP,  one  could,  in  principle, 
perform  a  magnitude  conversion  from  V  to  a  CCD  magnitude. 
However,  this  would  require  the  choice  of  a  particular  CCD 
detector  In  order  to  determine  Its  response  characteristics  In 
the  laboratory. 
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(2)  The  response  functions  of  typical  CCD's  are  quite  broad,  a 
fact  which  makes  a  rigorous  conversion  to  a  CCD  magnitude 
difficult  in  light  of  the  complicated  stellar  spectral  features 
in  the  blue  wavelength  region.  A  detailed  description  of  the 
spectra  would  be  required.  The  I  filter,  on  the  other  hand, 

is  confined  to  the  red  wavelengths  where  the  star  spectra  are 
relatively  smooth. 

(3)  The  I  filter  response  peak  is  near  that  of  typical  CCD's.  In 
addition,  it  overlaps  the  main  peaks  of  the  commonly  accepted 
"typical  CCD  response"  (Ref.  6).  Hence,  an  I  filter  placed 
over  the  CCD  array  would  serve  to  limit  the  wings  of  the  CCD 
response  and  still  provide  adequate  through-put  for  sensitivity. 

(4)  Information  exists  for  converting  V  magnitudes  to  I  magnitudes. 
The  transformation  requires  only  spectral  type  and  luminosity 
class  -  both  readily  available  from  SKYMAP. 

In  the  ideal  case,  the  set  of  detectable  stars  exactly  matches  the 
catalog.  Since  this  is  not  possible,  it  is  desirable  to  maximize  the 
completeness  of  the  catalog  to  some  rather  faint  magnitude  to  insure 
that  most  detectable  stars  are  contained.  It  is  important  to  note  that 
stars  which  are  faint  in  V  may  be  relatively  brighter  at  red  wavelengths. 
As  will  be  demonstrated  in  the  next  sections,  a  limit  of  magnitude  5  in 
I  seems  to  be  a  reasonable  limit  for  the  CCD  configuration  assumed  for 
the  present  study.  The  8th  magnitude  limit  of  SKYMAP  assures  that  the 
mission  catalog  listing  will  be  sufficient. 

A2.2.2  The  I  Magnitude  Conversion  Method 

Two  external  items  of  information  are  needed  for  the  magnitude 
conversion.  Values  of  V  ^  -  Iab$  were  obtained  from  Johnson  [7],  whose 
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table  contains  listings  for  three  luminosity  classes  (I,  III  &  V  - 
super  giants,  giants  and  main  sequence)  and  extends  over  most  spectral 
types.  The  second  value  needed  is  a^/ay,  the  ratios  of  absorption  in  I 
to  absorption  in  V,  expressed  in  magnitude  and  as  a  function  of  spectral 
type  by 

aI  1°91oC(/o“ftlCX)E(X>0  -  I(X)dX)/(/0"l(X)E(X)dX)] 
aV  '  log10C(/0"V(X)E(X)(l  -  I(X)dX)/(/0°°V(X)E(X)dX)] 

Where  1(A)  and  V(A)  are  the  filter  responses,  E(X)  is  the  star  energy 
function  and  1(A)  is  the  relative  absorption  function  and  X  is  the 
wavelength.  (See  SKYMAP  desciption  [5]  for  details).  As  pointed  out  in 
SKYMAP,  this  ratio  is  nearly  constant  over  spectral  type  for  narrow  or 
intermediate  band  filters.  To  calculate  this  ratio  the  Planck  energy 
function  was  used  to  model  the  stellar  flux.  Although  this  is  not 
precisely  valid,  forming  the  ratio  should  lead  to  quite  accurate  results. 
The  temperatures  used  were  those  given  by  Johnson  [7]  and  no  distinction 
was  made  by  luminosity  class.  The  values  for  absorption  were  taken  from 
Fig.  3.2  in  the  SKYMAP  description  by  assuming  absorption  in  magnitude 
is  a  linear  function  of  wavelength  over  the  range  of  interest  (4800  A  - 

10000  A), 

a(X)  =  1.77  x  10"4  x  X(A)  +  1.77,  (A2.4) 

Where  a(X)  is  absorption  in  magnitude  at  wavelength  X.  The  results  of 
these  calculations  were  that  aj/av  varied  from  0.25  to  0.32.  The  same 
value  of  aj/ay  was  used  for  I,  III  and  V  luminosity  class  stars  at  a 
given  spectral  type. 

A2.2.3  SKYMAP  DATA 

The  data  from  SKYMAP  needed  for  the  magnitude  conversion  consists 
of  apparant  visual  magnitude,  spectral  type,  luminosity  class  and 
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absorption  in  V.  These  data,  with  the  exception  of  ay,  are  given  for 
most  stars.  It  was  necessary  to  collapse  catagories  of  luminosity  class 
and  some  spectral  types  since  the  table  from  Johnson  is  limited. 

Collapsing  is  justified  in  most  cases  because  either  the  catagory  contains 
few  stars  and/or  the  properties  are  similar  to  those  of  listed  star 
types.  The  following  combinations  were  used: 


R 

N 

C 

S 


WR 

UC 

WN 

IV 

III 

II 


] 

] 


Luminosity  class  III,  spectral  type  M 
(all  are  variants  of  M  III) 


Lum  class  III,  spectral  type  09 
(all  are  hot  giant  stars  similar  to  09) 


III 

V 

I 


No  Luminosity  class  -*•  V  (most  stars  are  V  stars) 

No  subinterval  in  spectral  type  -*■  5  (i.e.,  A  becomes  A5) 

No  absorption  given  -*■  set  to  0 
No  spectral  type  -*■  exclude 

Given  the  spectral  type  and  luminosity  class,  the  value  of  Vabs  -  Iabs 
and  aj/av  were  found  by  interpolation  in  the  table.  Then: 
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mI  =  mV  '  (Vabs  “  W  “  V1  '  aI/aV) ’  (A2'5) 

where  and  a^  are  from  SKYMAP. 

SKYMAP  contains  approximately  45,000  stars.  Of  these,  37  were  not 
processed  due  to  missing  spectral  type  or  visual  magnitude. 

A2.2.4  Magnitude  Limit  of  CCD  Sensor 

In  order  to  establish  a  reasonable  magnitude  limit  for  a  CCD  sensor 
we  1)  determine  the  flux  in  the  filter  bandpass  for  some  standard  star 
at  the  earth's  atmosphere,  and  2)  multiply  by  appropriate  factors 
dictated  by  the  sensor. 

The  most  direct  way  to  obtain  a  flux  estimate  would  be  to  observe 
known  stars  from  space  with  the  CCD  sensor.  Barring  this,  gound-based 
observations  of  stars  with  varying  zenith  angles  could  yield  flux 
estimates  outside  the  earth's  atmosphere. 

Our  approximate  method  was  to  numerically  integrate  the  surface 
flux  distribution  of  a  K7  V  star  model  atmosphere  over  the  I  bandpass. 
The  absolute  I  magnitude  of  such  a  star  is  approximately  6.2  (V  =  8.1, 

V  -  I  =  1.92).  The  radius  is  given  by  log  R*/R$un  =  -0.11  where 

R  =  6.96  x  1010  cm.  The  surface  flux  is  scaled  by  (§ - x  yl^-)2 

sun  Rsun  lupc 

=  3.08  x  10'18  where  1  =  3.08  x  1017  cm.  The  result  of  integrating 

and  scaling  is: 

“1024  photons/cm2sec. 

Typical  scale  factors  are: 

-Lens  area:  26.7  cm2 

-CCD  response  peak  efficiency  =  .60 

-I  filter  transmission  peak  efficiency  =  0.85 
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-CCD  effective  area  utilization  =  0.46 

-Integration  time  =  0.1  sec. 

If  we  desire  a  minimum  of  7500  photons/star  for  a  sufficient  signal -to- 
noise  ratio,  we  compute  the  I  magnitude  limit  of: 

ml imit  =  6,2  +  2,5  log  =  3,5 

Note  that  many  factors  are  uncertain  or  could  be  altered.  Integration 
time  could  be  increased  to  1  sec  to  give  a  limit  of  6.0.  We  have  chosen 
5.0  to  be  the  cutoff  magnitude  since  this  seems  obtainable  and  gives 
approximately  5400  stars,  a  sufficient  number  for  the  pattern  recognition 
process  to  work  reliably. 

We  also  note  that  model  atmospheres  for  a  variety  of  spectral  types 
could  be  used  to  repeat  the  above  calculation  to  yield  a  more  precise 
magnitude  limit. 

The  magnitude  limit  is  flexible  since  the  integration  time  for  the 
star  sensor  is  variable  over  a  wide  range.  If  the  integration  time  is 
changed  by  a  factor  of  10  the  magnitude  limit  is  changed  by  2.5  mag.  In 
addition,  the  dynamic  range  to  typical  CCD  arrays  is  200  or  about  6 
magnitudes.  The  response  is  linear  over  the  range  to  allow  accurate 
magnitude  calibration  and  detection. 
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Appendix  3:  Star  Data  Base  And  Mission  Catalog  Creation 

The  star  catalog  data  base  system  SKYMAP  (Ref.  5)  has  been  selected 
as  the  master  star  data  base.  The  SKYMAP  catalog  was  developed  from 
the  SAO  catalog  and  other  sources  specifically  for  attitude  determination 
programs  by  NASA-GSFC.  It  is  complete  to  the  eighth  magnitude  in  either 
the  blue  (B)  or  visual  (V)  magnitudes.  Additionally,  the  catalog 
contains  right  ascensions,  declinations,  and,  when  known,  the  spectral 
type,  luminosity  class,  and  amount  of  interstellar  absorption  in  the  V 
wavelength  range.  Recent  work  [at  the  Naval  Surface  Weapons  Center]  has 
uncovered  a  significant  number  of  corrections  to  the  SKYMAP  data  base 
which  will  be  reflected  in  future  revisions  of  the  present  SKYMAP 
data  base. 

The  on-board  (or  mission)  star  catalog  is  divided  into  celestial 
sphere  cells  so  as  to  permit  efficient  microcomputer  access  during  the 
pattern  recognition  process.  In  order  to  keep  storage  requirements  for 
the  mission  catalog  to  a  minimum,  the  cells  do  not  overlap.  The  place¬ 
ment  of  the  cell  centers  is  given  by  the  polar  angle  0  and  longitude 
X  according  to 

6n  =  cos_1(Cn)  n  =  0,1,2. ..N  (A3. 1 ) 

and 

Xnj=fn+T  J  “  0,1,2,. ..Zn  (A3. 2) 

cn  =  (-l)n  cos(^gJT),  n  -  0,1,2.. .N  (A3. 3) 

These  formulae  yield  (N+l)2  points:  N+l  polar  angles  or  declination 
zones  with  spacing  2w/ ( 2N+1 ) ,  and  (2n+l)  equally  spaced  regions  in 
each  zone. 
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The  choice  of  N  is  somewhat  arbitrary.  A  large  N  yields  small  cells 
which  would  require  more  than  one  cell  to  be  accessed;  a  small  N  yields 
large  cells  which  would  increase  the  number  of  trials  in  the  pattern 
recognition  process  as  well  as  causing  a  possible  storage  problem. 

Taking  into  account  the  7°  x  9°  field-of-view,  a  value  of  N  =  22  was 
chosen,  yielding  529  cells. 

To  facilitate  computer  access,  the  cells  are  ordered  within  memory 
according  to  a  parameter  n2+j;  a  table  lists  the  starting  relative 
address  of  each  cell  and  the  number  of  stars  in  each.  Thus,  given  a 
boresight  estimate  (0,A),  the  primary  cell  location  is  given  by 

n  =  2[0/A0  +  0.5]  (0  <  90°) 

=  2N  +  1  -  2[0/A0  +  0.5]  (6  >  90°)  (A3. 4) 

j  =  [A/AA  +  0.5],  (A3. 5) 

where  [x]  indicates  integer  arithmetic  (truncation  to  next  smallest 
integer).  The  table  of  cells  is  then  consulted  for  identification  of 
the  appropriate  memory  location.  In  all,  the  catalog  access  routine 
reads  data  from  the  4  nearest  neighboring  cells  around  the  estimated 
boresight  (Figure  A3.1)  and  thus  provides  nearly  complete  coverage  of 
the  estimated  FOV  by  the  4  cells. 

The  CCD  is  assumed  (see  Appendix  2)  to  respond  to  stars  of  I 
magnitude  5  or  lower  -  approximately  5400  stars.  If  these  5400  stars 
are  assumed  to  be  distributed  uniformly  over  the  celestial  sphere,  the 
star  density  p  would  be 


-  5400  stars/ sphere 
p  ”  41,253  square  degrees/ sphere 


(A3. 6) 


=  0.13  stars/square  degree 
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For  a  field-of-view  of  7°  x  9°  =  63  square  degrees,  we  would  expect 

(63  square  degrees)(0.13  stars/square  degree)  =  8.2  stars* 

in  a  field-of-view  (assuming  uniform  density).  To  obtain  a  measure  of 
the  range  of  the  number  of  stars  actually  detectable  per  field-of-view, 
the  boresight  was  randomly  oriented  over  the  entire  celestial  sphere  100 
times.  For  each  trial,  the  mission  catalog  was  consulted  and  the  number 
of  stars  in  the  field-of-view  recorded.  The  average  number  of  stars  per 
field-of-view  was  six;  in  no  case  were  fewer  than  two  stars  in  the 
field-of-view. 


*Due  to  non-uniform  star  population 
number  decreases  to  about  5  at 


of  the  celestial  sphere,  this 
the  north  galactic  pole. 


Appendix  4:  Inter-Star  Cosine  Calculations 

The  key  to  efficient  star  identification  is  to  take  advantage  of 
the  sub-ten-arcsecond  precession  of  Process  A;  the  angles  between  pairs 
of  measured  stars  are  very  well  determined  by  the  measured  coordinates 
and  can  be  used  to  identify  the  corresponding  catalog  stars.  The  cosine 
of  the  angle  between  a  typical  pair  of  measured  stars  can  be  computed 
from  the  measured  image  coordinates  as 

xixi  +  y.y,  +  f2 

c4,  =  cos  8,,  =  - J - 1,1 -  (A4.1 ) 

,J  ,J  /<v  ♦  V  ♦  fiKxj’ *  V  -  f>) 

The  cosine  of  the  angle  between  a  typical  pair  of  catalog  stars  can  be 
computed  from  the  catalog  direction  cosines  as 

CIJ  s  cos  0IJ  =  LI1  LJ1  +  LI2  LJ2  +  LI3  LJ3'  (A4,2) 

The  pattern  recognition  logic  we  developed  makes  use  of  the 
smallness  of  the  difference  between  (A4.1)  and  (A4.2)  as  a  means  to 
tentatively  identify  measured  stars  in  the  catalog.  Our  strategy 
assumes  a  steady-state  condition  in  which  the  estimated  boresight  is 
within  a  degree  or  so  of  the  true  boresight  direction.  Thus,  the 
highest  probability  of  finding  a  pair  match  lies  in  comparing  stars  from 
the  center  of  the  sub-catalog  distribution.  For  this  reason,  we  sort 
the  sub-catalog  stars  by  angular  distance  from  the  boresight.  We 
proceed  to  pair  catalog  stars  by  using  the  sum  of  the  star  indices 
(after  sorting)  as  our  criterion  for  the  pairing  order.  Each  catalog 
pair  is  compared  with  the  pairs  of  measured  stars  (cosines  are  stored 
in  a  table).  We  eliminate  from  consideration  star  pairs  with  separation 
less  than  one  degree  because  of  the  possible  large  "roll"  error  about 


the  boresight.  In  addition,  we  do  not  use  catalog  pairs  with  sepa¬ 
rations  greater  than  about  10  degrees  (greater  than  the  FOV  size).  If 
we  find  agreement  between  a  catalog  pair  and  measured  pair  we  perform  a 
magnitude  test  to  resolve  the  180°  ambiguity. 

The  above  strategy  is  not  necessarily  optimal.  However,  we  have 
found  it  to  be  very  efficient  and  it  allows  for  ^  mismatch  of  several 
degrees,  at  least,  between  the  estimated  and  true  boresight  vectors. 
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Appendix  5:  Stellar  Aberration 

The  effect  of  stellar  aberration  is  to  cause  a  star's  apparent 
direction  to  shift  towards  the  direction  of  the  observers  motion.  The 
amount  of  shift  depends  on  both  the  velocity  of  the  observer  and  on  the 
angle  between  the  observer's  line  of  sight  (the  star  direction)  and  the 
velocity  vector.  The  shift  is: 

a  -  ^  sin  a  (A5.1 ) 

where  a  =  aberration  in  radians 
v  ■  observer's  speed 
c  =  velocity  of  light 

a  =  angle  between  velocity  vector  and  the  true  star  direction. 

For  our  purpose,  we  must  express  a  star's  shifted  direction  in  terms  of 
the  true  direction,  the  vehicle  velocity  and  the  angle  between  the 
velocity  vector  and  true  direction;  that  is, 

,Lz,v,a)  (A5.2) 

If  we  let  v^  be  t.he  velocity  of  starlight  in  the  inertial  frame  and 
v  be  observer  velocity,  then  the  relative  velocity  of  the  starlight  as 
seen  by  the  observer  is: 

VO  =  *s  •  ±  (A5*3) 

A  /\ 

Now,  if  we  let  JL  be  the  unit  vector  in  the  true  direction  and  Si'  the 
— n  —  n 

unit  vector  in  the  shifted  direction,  we  can  rewrite  this  as  (refer  to 


Figure  A5.1) 


(c  +  v  cos  a)  £'  =  cJL  +  v 
'  '  — n  — n  — 

To  first  order  this  becomes 


(A5.4) 

(A5.5) 


This  equation  is  used  for  calculating  the  displacement  of  a  star's 
unit  vector-  The  velocity  vector  is  computed  for  the  combined  velocity 
of  the  earth  and  satellite  and  Herrick's  "f  and  g"  solution  is  used  to 
calculate  the  individual  velocities  each  time  Process  B  accepts  new  data 
from  Process  A. 

We  note  several  points  concerning  the  effects  of  aberration  on  the 
star  tracker.  The  speed  of  the  earth  in  its  orbit  is  30  km/s  and  the 
maximum  speed  of  an  earth  orbiting  satellite  is  <  8  km/s  relative  to 
the  earth.  Therefore,  the  maximum  shift  in  a  star's  direction  is  about 
26  arcseconds.  This  maximum  occurs  for  stars  90°  from  the  velocity 
vector.  However,  all  stars  In  this  neighborhood  will  be  shifted  by 
nearly  this  amount  and,  thus,  the  distortion  of  the  FOV  will  be 
insignificant.  However,  aberration  will  displace  the  boresight  direction. 
To  avoid  orientation  errors  in  the  combined  FOV(A)  and  FOV(B)  solution 
we  must  correct  the  catalogue  direction  cosines  by  applying  Eq.  (A5.6). 


For  those  stars  in  the  direction  of  the  velocity  vector,  the  shift 
in  direction  will  be  small.  But  since  the  shift  is  always  towards  the 
velocity  vector  the  distortion  is  noticeable  (an  apparant  shrinking  of 


the  FOV).  In  this  case,  the  aberration  should  be  applied  before  the 
final  least-squares  solution  for  the  single  FOV. 

We  have  chosen  to  correct  for  aberration  when  a  sub-catalog  is 
selected  from  the  mission  catalog.  This  decision  was  based  on  programing 
ease  although  it  does  require  more  time  to  correct  the  whole  sample 
rather  than  only  the  matched  stars.  The  impact  is  not  severe,  however, 
since  the  calculation  is  very  simple. 


i 

I 

1 


6 
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Appendix  6: 


Least-Squares  Correction  Techniques 


In  Process  B  we  seek  to  minimize  the  sum  of  the  squares  of  the 
residuals  between  measured  star  image  coordinates  and  predicted  coordi¬ 
nates  for  the  same  stars,  using  direction  cosines  from  the  on-board 
catalog.  The  mapping  of  catalog  positions  onto  the  CCO  image  plane  is  a 
function  of  Euler  parameters  via  the  stellar  colinearity  equations: 


.  f?ANnLi  ±  AN12L2  +  AN13L3? 

T|AN3iL1  +  AN32L2  +  AN33L3J 


y 


fjAN2iLi  +  AN22L2  +  AN23L3I 
^  AN 3 1 L 1  +  AN32L2  +  AN33L3 


(A6.1 ) 


where 


f  =  lens  focal  length 

AN—  =  elements  of  the  coordinate  frame  rotation  matrix  [AN]. 

Lj  =  star  direction  cosines  for  the  particular  star,  measured  in 
the  N  frame. 


If  we  let: 

X  =  {(x^,y^)}  =  vector  of  calculated  CCD  image  plane  coordinates. 

X  =  {(x^,yi)}m  =  vector  of  measured  star  image  positions  on  the  CCD. 
and 

AX  =  X  -  X  =  vector  of  residuals, 

then  we  seek  to  find  the  set  of  Euler  parameters,  3,  such  that  the 
weighted  sum  of  the  squares  of  the  residuals  is  minimized;  i.e.,  minimize 

♦  -  AXpWAXp  (A6.2) 


where 
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and 

Xp  =  vector  of  linearly  predicted  image  coordinates. 

But,  by  first-order  Taylor  expansion 

AX  =  AX  -  AA8 
P  c 

where 

AXC  =  vector  of  current  image  coordinate  residuals  based  current 
estimates  of  8. 

A  »  matrix  of  partial  derivatives  of  the  colinearity  equations 
with  respect  to  Euler  parameters. 

AB  =  corrections  to  the  current  estimates  of  Euler  parameters. 

Thus,  we  can  write: 

4>p  =  (AXC  -  AAB)T  W(AXc  -  AAB).  (A6.4) 

In  addition  to  finding  the  set  of  Euler  parameters  to  minimize  <j>p,  we  must 
also  satisfy  the  constraint  equation: 

BT8  =  1.  (A6.5) 

Letting  Bp  =  8C  +  AB,  we  find: 

(Bc  +  AB)T  (Bc  +  AB)  =  1 

or  to  first  order: 

1  -  BTcBc  =  2bJaB.  (A6.6) 

Thus,  our  problem  requires  that  we  minimize  Eq.  A6.4  subject  to  the 
constraint  equation,  Eq.  A6.6.  The  constraint  equation  can  be  incorpor¬ 
ated  in  Eq.  A6.4  as  an  additional  pevfeot  observation  equation  but  with  a 
large  weight.  That  is,  AY  =  (1  -  BT6)  Is  appended  to  the  AXC  vector  and 
28T  appended  as  an  additional  row  into  the  A  matrix.  The  relative  weight 
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for  this  equation,  the  last  element  of  W,  is  chosen  large  enough  (about 
103)  so  that  (A^WA)"1  does  not  change  appreciably  for  variations  in  this 
weight.  Then,  for  minimization,  we  require: 

VAf34>  =  -2ATWAXc  +  2(ATWA)AB  =  0 
or 

A3  =  (ATWA)-1  ATWAXc.  (A6.7) 

Determination  of  Interlock  Euler  Parameters  Between  FOV(A)  and  FOV(B) 

Process  B,  in  analyzing  star  image  data,  first  treats  FOV(A)  and 
FOV(B)  independently.  The  least-squares  differential  correction  deter¬ 
mines  the  best  estimate  of  the  Euler  parameters  (3yN)  orienting  the 
vehicle  frame,  V  (see  Appendix  7),  relative  to  the  inertial  frame,  N. 

For  FOV(B)  the  interlock  relationship  between  FOV(A)  and  FOV(B)  (8BA)  is 
assumed  known  and  BVN  is  adjusted  again.  In  reality,  however,  the 
interlocks  do  vary  slightly  with  time.  Therefore,  we  have  expanded  our 
algorithm  to  treat  the  combined  data  from  FOV(A)  and  FOV(B)  in  order  to 
determine,  simultaneously,  the  3VN  and  3BA  which  minimize  (in  a  least- 
squares  sense)  the  star  image  coordinate  residuals  (see  Appendix  7  for 
further  details). 

In  order  to  rigorously  interpret  (ATWA)-i  as  the  8x8  covariance 
matrix  of  the  estimated  Euler  parameters,  W  should  be  chosen  as  the 
inverse  of  the  "measurement"  covariance  matrix.  However,  since  a  scale 
factor  on  u  is  formally  immaterial  in  the  least  squares  solution  and 
assuming  all  measurement  errors  are  uncorrelated  we  exercise  the  simple 
option  of  setting  W  to  an  identity  matrix  except  for  the  larger  constraint 
weights;  the  correct  covariance  matrix  is  obtained  by  simply  multiplying 
the  converged  (A^WA)"1  matrix  by  the  image  coordinate  measurement 
variance.  The  two  constraints  of  the  form  (A6.6)  are  treated  as  "perfect 
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measurements".  Thus,  it  is  clear  that  the  two  corresponding  formal 
weights  are  <»;  it  is  equally  clear  that  we  are  limited  to  choosing  a 
sufficiently  large  number  (about  103)  in  practice.  We  have  carried  out 
sufficient  experimentation  to  expect  no  implementation  problems  here; 
the  differential  correction  process  converges  well. 

We  have  found  it  desirable  to  further  process  the  interlock  Euler 
parameters,  egA.  We  assume  (justifiably.')  that  these  interlocks  vary 
slowly  with  time,  but  the  interlocks  calculated  by  the  combined  least- 
squares  method,  discussed  above,  show  relatively  large  scatter  about 
their  true  values.  This  sensitivity  is  due  to  the  relatively  poor 
determination  of  the  roll  about  each  boresight  (this  does  not  affect  the 
determination  of  PVN)-  To  better  monitor  the  interlock  parameters  we 
adopted  a  discrete  Kalman  filter  algorithm  to  combine  the  predicted  bba> 
determined  from  previous  data  frames,  with  the  3gA  computed  by  the 
least-squares  correction.  The  equations  needed  for  this  are: 


S(ja(*0  =  +  -  PgA^)) 

K(k)  =  Pj^dOU-y  v  +  pk_!  (k)  )_1 

VlOO  ■  pk-l<k-1)  +  Q(k) 

Pk(k)  =  (I  -  K(k))Pk_1(k) 

Q(k)  =  BQ'BT 


where  egA(k)  =  optimal  estimate  of  interlock  parameters  at  time  tk 
obtained  by  combining  predicted  and  computed  values, 
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3BA(k) 

Wk^ 

K(k) 

Pi(j) 


Q(k) 

Q' 


predicted  interlock  parameters  at  time  t^  based  on 
previous  analysis, 

interlock  parameters  at  time  t^  obtained  via  least- 
squares  correction, 

Kalman  gain  matrix  at  time  t^, 

covariance  matrix  associated  with  BgA  at  time  t^  based 
on  analysis  of  interlock  values  through  time  t., 
covariance  matrix  associated  with  calculated  interlock 
parameters ,  6BA(k). 
process  noise  matrix, 

process  noise  matrix  for  3  interlock  angles  (<f>  = 

{4*1  J<t12  ,<f>3  1 ) 


Formally,  Pk_-|(k)  would  be  obtained  by  forward  integration  of  the  matrix 
Riccati  equation,  or  by  other  methods.  However,  since  to  first  order, 

BBA  =  0  and  assuming  the  process  noise  is  constant  in  time  as  well, 
Pk_-,(k)  is  obtained  by  simply  adding  the  time  integral  of  the  process 
noise,  Q(k),  to  the  previous  covariance,  Pk_-|(k-l).  In  addition,  for 
simplicity  we  assume  Q'  is  diagonal  with  equal  noise  for  each  angle. 

For  programming  ease  we  have  used  a  pre-calculated  B  matrix,  valid  for 
our  nominal  interlock  arrangement. 

The  process  noise  matrix  Q'  essentially  controls  the  scatter  of 
the  estimated  Euler  parameters.  Small  values  for  the  elements  of  Q'  will 
permit  little  change  in  the  (making  it  insensitive  to  each  new  8BA). 
However,  this  may  cause  the  eBA  not  to  "track"  the  true  variations. 
Conversely,  large  values  for  Q'  elements  will  cause  more  scatter  in 
Obviously,  Q*  is  a  "tuning"  parameter  which  must  be  selected  for  the 
particular  system. 
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Appendix  7:  Orientation  of  the  Vehicle  Frame 

We  describe  the  vehicle  orientation  by  the  set  of  Euler  parameters, 

which  orient  a  "V"  frame  (defined  below)  relative  to  the  inertial 
frame,  "N".  The  V  frame  is  defined  entirely  by  the  boresight  vectors  of 
the  two  star  sensors  [FOV(A),  FOV(B)].  Given  the  boresight  of  FOV(A)  as 
a^  and  of  FOV(B)  by  b^3,  we  define  the  V  frame  unit  vectors  as  follows: 

Vi  =  (a^3  +  b.3)/(  |a3  +  b^3 1 ) 

v3  =  (a3  x  b3)/(|a3  *  b3|)  (A7.1) 

V2  =  v3  x  v^j 

The  advantage  of  this  frame  is  that  since  the  boresights  of  the  two  FOV 
are  well  determined  so  also  will  be  the  V  frame  and,  hence,  the  BVN 
parameter  set.  The  poorly  determined  roll  angle  about  each  boresight 
will  not  affect  3VN« 

In  addition  to  B^,  we  also  make  use  of  Bg^,  the  Euler  parameters 
orienting  FOV(B)  with  respect  to  FOV(A).  These  parameters  are  monitored 
as  a  means  for  monitoring  the  interlock  angles  between  FOV(A)  and  FOV(B). 

As  we  will  show  below,  we  do  not  actually  need  the  v  unit  vectors 
calculated  by  the  above  equations.  We  do  need,  however,  the  rotation 
matrix  AV  which  rotates  the  V  frame  into  the  FOV(A)  frame.  The  matrix 
AV  can  be  calculated  from  the  BA  rotation  matrix. 

Matrix  AV  can  be  constructed  by  filling  its  columns  with  the  v  unit 
vectors  expressed  in  the  A  frame.  We  first  express  b3  in  terms  of  a^ 
unit  vectrors  in  order  to  calculate  the  vectors  Vi,  V2,  v^  (in  the  A 
frame) . 

b}  =  BA  a?  (A7.2) 


And  since 
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we  see  that 


(A7.3) 


(A7 .4) 


Therefore,  in  the  A  frame: 


vt  =  (a[3  +  _b 3 ) / ( 1  ^.3  +  b.3 ! ) 


1 


_ BAjj _ I ^  _ BAj us..  >  1  +  BA33i 

(2  +  2BA3 3 )  /2’  (2  +  2BA33)  '2>  (2  +  2BA33)  7 2 


(A7.5) 


-J 


v.3  =  (a. 3  x  b3)/(|a^3  *  b3| ) 


- 

"BA3.21 

(i1 

-  BAf,)7' 

BA 


(1  -  BA|3) 


°> 


.J 


(A7.6) 


V2  =  V3  X  Vi 


BA31 


(2  -  2BA33)  /z’  (2  -  2BA33)  /z 


““-tt.  itt.-.  Wul.'f  (W.7) 


The  vectors,  v^,  expressed  in  the  A  frame,  form  the  columns  of  matrix  AV. 
We  see  that  AV  is  a  function  of  just  3  variables  BA  , ,  i  =  1,  2,  3.  For 

3  ' 

the  least-squares  differential  correction  of  Process  B  we  need  the  partial 
derivatives  3AV/a$j ,  j  *  0,  1,  2,  3.  To  simplify  the  calculations  we 
expand  this: 
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3AV  _  ?  3AV  9BA3i 
3ej  "  i=l  ^37  30j 


(A7.8) 


3AV 


3BA. 


3i 


3BA3i 

is  a  3  x  3  matrix  and  — •  are  elements  of  a  3  x  3  matrix 


where 
SBA 

go—.  The  partials  aAV/SBA.^. ,  after  some  algebra, are 
J 


1  I 

1 

0 

(2  +  2BA33)72  j 

(2  - 

2BA33)  72 

3AV  _ 

1 

n  1 

n 

1 

3BA3  i 

1 

u 

(1  -  BA  33) 7  z 

1 

0  1 

0 

0 

n  1 

0 

-1 

u 

1 

1 

(1  -  BAI3)72 

3AV  _ 

1 

1  1 

1 

0 

3BA3  2 

(2  +  2BA33) 7z  | 

(2  - 

2BA33)72 

! 

0  s 

0 

0 

“BA 31  j  .  | 

BA  3 1 

-BA  3  ? BA  3 1 

(2  +  2BA33)72  i 

(2  - 

2BA33)72 

(i  -  BA§3)  /z 

3AV  .. 

1 

_-BA„  ^  1 

BA  3  2 

BA,, BA, , 

3BA3  3 

(2  +  2BA33) Vz 

(2  - 

2BA33) 3/2 

(1  -  BAf,)*7* 

1  1 

1 

0 

2(2  +  2BA3i)^2  1 

2(2 

2BA33) 1/2 

(A7.9a-c 


We  now  consider  in  some  detail  how  the  derivative  matrix  for  the  least- 
squares  differential  correction  is  filled  to  recover  0VN  and  Bgft.  The 
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r  , 


i 

I 

I 

I 

I 

I 

1 


elements  of  the  A  matrix  for  treating  a  single  FOV  are  found  by  expanding 

ax  . 

98vn' 


ax 


ae 


VN 


_  ax_  aAN 

'  8AN  ae. 


VN 


[for  FOV (A)] 


=  ISN  VN  +  AV  !I^)  <us1"9  flN  ■  «  •  ™> 

=  ax  [ AV  WL\ 

9AN  \AV  36VJ 


(A7.10) 


ax 


36, 


VN 


ax  a  bn 


a  BN  36. 


_  ax_  /3B V 

■  a bn  \aeVN 


VN 

aBV 


[for  FOV (B }] 


VN  +  BV 


aVM 


36, 


VN 


) 


-  ax_  (rm  avN  \ 

-  a bn  a 6VNj 


(using  BN  =  BV  •  VN  and  BV  =  BA  •  AV) 


(A7.ll) 


After  matching  at  least  3  stars  in  each  FOV,  we  can  combine  both  FOV 
to  recover  the  interlock  parameter  6g^  as  well  as  6VN-  In  this  case,  we 
need  the  following  matrix  derivatives: 


The  elements  of  the  vectors  AX  and  AB  and  matrix  A  are: 


AX 


‘(Ax.  Ay)A 
(Ax,  Ay)B 

1  '  3VN3VN 
1  '  3BA3BA 


=  vector  of  image  residuals  for  F0V(A f 
=  vector  of  image  residuals  for  FOV(B) 
=  constraint  condition  for  BVN 
=  constraint  condition  for  BB; 

_ 


=  correction  vector  for  ByN 


AB  = 


_A8ba  =  correction  vector  for  BBAJ 


3(x,  y) 

1 

A  j 

3(x,  y) 

3vn 

33ba 

a(x,  y) 

— 1 

1 

9(x,  y) 

3vn 

B  j 

3ba 

bt  w!/z 
3vnWi 

1 

1 

J_ 

0 

0 

1 

y  V 2 
W1 

Then  AB  =  (ATWA)_l  ATWAX;  the  corrections  are  added  to  ByN  and  BgA 
the  process  is  repeated  until  AB  is  small.  The  final  values  for  B^ 
passed  to  Process  C. 
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Appendix  8:  Riccatl  Equation  Covariance  Propagation 

The  Kalman  filter  formulated  for  Process  C  includes  a  direct 
numerical  integration  of  the  covariance  matrix  between  two  time  points. 
This  allows  a  more  rigorous  incorporation  of  the  process  noise  component 
in  the  covariance  matrix  propagation.  Our  initial  method  was  to  compute 
the  state  transition  matrix  to  use  this  to  propagate  covariance  by  pre- 
and  post-multiplication  of  the  previous  covariance  matrix.  An  estimate 
of  the  process  noise  estimate  was  then  added  on.  We  outline  the  covar¬ 
iance  integration  technique  below. 

We  have  chosen  as  our  state  vector: 
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Bi 

02 


03 

'4  Euler  parameters,  8VN,  orienting  the' 

X  = 

y  „ 

= 

— 

s 

vehicle  frame  with  respect  to  inertial 

LazJ 

bi 

frame,  N,  and  3  gyro  bias  values,  b.  . 

b2 

b3 


The  state  differential  equations  for  our  system  are: 
{^i)  =  =  [Bvn][VG]{u>gn} 

=  [0VN]{wVN> 

=  £wvn1{bvn} 

{*2}  -  {6}  -  o 


(A8.1a) 

(A8.1b) 

(A8.2) 


where 
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-Pi 

“02 

“03 

00 

“03 

02 

03 

00 

“01 

“02 

01 

00 

0 

-0)1 

-0)2 

“0)3 

0)1 

0 

“>3 

“0)2 

0)2 

-0)3 

0 

0)1 

0)3 

0)2 

-0)t 

0 

{wq^}  =  vector  of  true  rotation  rates  of  the  vehicle 
about  three  orthogonal  body  fixed  axes, 

[VG]  =3x3  rotation  matrix  which  rotates  the  gyro 

rates  from  the  gyro  frame  to  the  vehicle  frame. 

Our  model  for  each  gyro  measurement,  o)gN,  includes  an  unknown  noise 
term,  V,  and  a  gyro  bias,  bgN,  which  we  can  estimate.  Then,  the  state 
differential  equation  for  {X i >  becomes: 

iU}  =  C6VNKVG]({wGN}  -  {bGN}  +  {V}) 

=  ^VNK6VN}  '  ^VN][VG]{bGN}  +  CfWNGKV}.  (A8-3> 

Combining  the  two  state  differential  equations,  they  can  be  rewritten  in 
a  linear  form: 

i  =  Fx  +  Gv , 


"1 

Fu 

1 

1  Ji 

1  M 

1 

C4 

1  Ll. 

F22 
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— 
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1  1 

'  £ 

1  ^ 

1 

-[3vn][VG] 

1 

O 

i 

o 

Gn  1 

[6vn3[VG]  |  0  1 

G  = 

—  -| - 

11 

1 

1 

1 

l 

1 

-+- 

1 

1 

_L 

G21  1 

G22 

0  |S*[I] 

S  =  a  scale  factor  or  "tuning"  parameter. 

The  covariance  matrix  propagation  is  calculated  by  numerical  integration 
of  the  matrix  Riccati  equation: 

P  =  FP  +  PFT  +  GQGT  (A8.4) 


where  P  is  the  covariance  matrix  and  Q  is  the  process  noise  covariance 
matrix  which,  in  our  case,  represents  a  measure  of  the  noise  covariance 
between  gyro  rates  about  the  three  axes  and  between  the  three  gyro 
biases.  This  matrix  is  taken  to  be  a  6  x  6  diagonal  matrix.  In  order 
to  speed  computation  we  partition  this  equation: 


^12 

^21  ^22 


Fn  Fi2 

F21  F22 
Gn  G12 

G2i  G22 


P11  P12 


P21  P22 


Pll  P 12 


P2 1  P22 


ft  ft 

hll  .'21 


FT  ft 
r 12  r22 


Qn 

Ql2 

Q21 

Q22 

“i  rG t  gt n 

Gn  fa21 


g|2  g22 


Since  F21  =  0,  F22  =  0,  G12  =  0,  G21  =  0,  Q12  -  0,  and  Q21  =  0  we  can 
write  the  set  of  four  equations  Implied  in  the  above  equation  as 
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^11  =  ^1 1P1 1  +  P12P21  +  P1 1  pTl  +  P12pl2  +  SiiQn6j2 
^12  a  P11P12  +  P12P22 
^21  =  P21pIl  +  P22P12 
^  22  =  ^22p22®22 • 

T  T  T 

Also,  since  P  is  symmetric,  P12  =  P21,  Pu  =  Pn,  P22  =  P22  and  since 
Fu  *  [w],  which  is  skew  symmetric,  F^  =  -Fn,  and  6i  =  -Fl2.  Therefore, 

Pn  =  (pnpn  +  pi2p2i)  +  (pnpii  +  pi2p2i)^  +  F12Qf{2 

^21  =  P22P12  ”  P2 1 P1 1  =  ^12* 

We  must  integrate  three  matrix  differential  equations,  Pn,  P21  and  P22 
to  propagate  the  covariance  matrix.  Only  two  matrices  need  to  be 
filled  at  each  time  step  in  the  integration:  (P22  is  a  constant) 

F 1 1  = 

and 

F12  =  -CS][VG]. 

The  simplest  form  for  the  state  differential  equation  for  the  $VN  is 
then 

L  =  tpi23({bg^}  - 

Currently,  we  are  using  a  two  cycle  Runge-Kutta  numerical  integration  for 
the  Riccati  equation. 

Kalman  Filter  State  Update  with  A-Priori  Information 

As  mentioned  in  the  Phase  II  report,  the  Kalman  filter,  as  formulated 
in  that  report,  did  not  estimate  the  gyro  bias  values  with  the  desired 
precision.  This  shortcoming  was  due,  in  part,  to  the  gyro  rate  noise 
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having  a  magnitude  similar  to  the  biases  themselves.  We  have  remedied 
this  problem  by  reformulating  the  Kalman  filter  to  treat  the  biases  as 
observable  with  an  associated  covariance  matrix.  Such  a  method  seems 
justified  since,  in  general,  the  biases  vary  slowly  on  the  time  scale  of 
minutes  and,  therefore,  we  would  have  some  knowledge  of  them  obtained 
from  previous  iterations. 

The  general  form  for  the  discrete  Kalman  filter  state  update  equation 
for  a  linear  system  is 

4+1(k  +  1)  =  4(k  +  1)  +  K(k  +  l)[Z(k  +  1)  -  H(k  +  DX^k  +  1)] 

(A8.5) 

where  Z  is  the  measurement  vector  at  time  tk+1  and  Xj,(k  +  1)  is  the  state, 
integrated  from  time  tk  to  tk+-| .  In  our  formulations,  Z  contains  the 
output  of  Process  B,  the  set  of  Euler  parameters  0VN  relating  the  V  frame 
to  the  inertial  frame,  and  the  three  bias  values  from  the  previous  pass 
through  the  Kalman  filter.  Thus,  the  observation  vector  Z  contains  the 
same  variables  as  the  state  vector  making  matrix  H  =  [I]. 

Looking  now  at  the  other  equations  for  the  Kalman  filter: 

K(k  +  1)  =  Pk(k  +  1 )HT(k  +  l)[L(k  +  1)  +  H(k  +  l)Pk(k  +  l)HT(k  +  1)]‘ 

=  Pk(k  +  1 )[L(k  +  1)  +  Pk(k  +  l)]-1  (A8.6) 

where  L(k  +  1)  =  covariance  matrix  for  the  measurements  and  Pk(k  +  1)  = 
integrated  covariance  from  the  Riccati  equation.  The  upper  left  4x4 
portion  of  L  is  the  covariance  matrix  from  the  least-squares  results  of 
Process  B.  The  lower  right  3x3  portion  of  L  is  the  covariance  matrix  of 
the  gyro  biases.  This  we  have  assumed  to  be  diagonal  (gyro  biases  are 
assumed  independent);  off  diagonal  protions  of  L  are  assumed  to  be  zero. 

The  covariance  matrix  update  equation  is 
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Pk+1(k  +  1)  -  [I  -  K(k  +  1 )H(k  +  l)]Pk(k  +  1) 

=  Pk(k  +  1)  -  K(k  +  l)Pk(k  +  1)  (A8.7) 

Bias  Estimation  Results 

Our  simulations  indicate  that  the  formulation  discussed  above 
functions  extremely  well.  We  note  that  as  the  estimated  variance  is 
decreased  we  get  an  improvement  in  the  bias  estimate.  However,  a  stricter 
value  on  the  bias  variance  also  decreases  the  response  time  of  the  system 
in  tracking  a  bias  change. 

It  must  be  kept  in  mind  that  the  gyro  biases,  as  we  have  defined 
them,  include  not  only  true  gyro  bias  but  also  other  effects  such  as  gyro 
nonorthogonality,  gravity  or  magnetic  effects,  and  poorly  known  interlock 
angles  between  sensor  and  gyro  frames.  It  is  expected  that  on  the  short 
term  the  gyro  bias  terms  will  absorb  these  Wwn &  and  permit  the  state 
integrations  to  yield  good  updates. 


i 

I 

I 
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Appendix  9:  Rate  Gyro  Readout  Data  Generation 

The  simplest  or  nominal  rotation  history  for  a  satellite  for  our 
study  is  one  rotation  per  revolution  around  the  earth.  For  our  geometry 
this  would  be  rotation  about  the  g2  unit  vector,  normal  to  the  orbit 
plane.  To  be  more  realistic  and  provide  a  challenge  to  the  software,  we 
have  formulated  a  more  complicated  read-out  record  for  the  gyroscopes. 

In  a  satellite  there  may  be  various  motors,  panels  and  antennae.  Each 
of  these  may  vibrate  at  various  frequencies.  Therefore,  we  have  gener¬ 
ated  gyro  rates  with  a  spectrum  of  frequencies,  phases  and  amplitudes. 

To  do  this  we  have  created  data  in  the  (Discrete)  Fourier  Transform 
space  or  frequency  space.  A  Fast  Fourier  Transform  of  the  data  yields  a 
gyro  record.  We  used  the  formula 

f,  «  e"loj  G.  (A9.1 ) 

J  J 

to  generate  a  frequency  specturm,  where  G.  is  a  Gaussian  distributed 

J 

random  number.  We  make  the  real  transform  symmetric  about  zero  frequency 
and  the  imaginary  data  anti -symmetric  in  order  yield  a  real  gyro  record. 

With  proper  scaling,  we  have  used  the  above  form  to  generate  a  gyro 
readout  every  0.5  sec.  for  each  gyro  axis. 

Proper  application  of  the  above  technique  yields  a  realistic  gyro 
record,  but  it  has  the  disadvantage  of  making  it  difficult  to  specify  a 
tstuz  rotation  and  attitude  history  for  the  spacecraft.  That  is,  Runge- 
Kutta  integration  is  designed  to  integrate  smooth  functions  whereas  this 
rate  simulation  is  discrete.  Also,  in  a  real  system  some  of  the  frequencies 
recorded  by  the  gyroscopes  are  just  vibration  or  noise  and  not  rotation. 

For  consistency,  we  decided  to  Integrate  the  gyro  record  using  two-cycle 
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Runge-Kutta  in  both  the  truth  model  programs  and  Process  C.  This  at 
least  allows  comparison  between  models  with  and  without  additional 
noise.  We  have  performed  several  tests  to  determine  the  effects  of  gyro 
noise  and  a  complicated  signal.  These  tests  confirm  our  intuition  that 
if  we  take  a  sufficient  number  of  samples,  the  rapid  zero  mean  oscil¬ 
lations  about  the  mean  motion  do  not  significantly  affect  the  integrated 
solution. 
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Appendix  10:  Software  Documentation,  Program 
Listings  and  Sample  Output 

This  appendix  is  divided  into  several  parts.  We  first  describe 
and  list  the  program  which  generates  simulated  data,  Datgen,  and  the 
program  which  processes  the  data  using  Processes  B  and  C,  Combi n . 

Then,  since  these  two  programs  have  several  subroutines  in  common,  we 
describe  and  list  all  the  subroutines  for  these  programs,  in  alphabet¬ 
ical  order.  Figures  A10.1  and  A10.2  display  the  hierarchy  of  subroutine 
calls  for  these  two  programs. 

A  sample  of  program  output  is  presented  also. 


AD-A1Q3  006  VIRGINIA  POLYTECHNIC  INST  AND  STATE  UNIV  BLACKSBURG  —ETC  F/G  17/7 
STAR  PATTERN  RECOGNITION  AND  SPACECRAFT  ATTITUDE  DETERMINATION, (U> 
MAY  81  T  E  STRIKWERDA*  J  L  JUNK  INS  DAAK7O-70-C-OO38 

ETL-0260  NL 


UNCLASSIFIED 
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Datgen 

This  program  generates  simulated  data  which  is  used  for  tests  of 
Processes  B  and  C.  The  data  for  a  sequence  of  frames  are  written  to  a 
disk  or  tape  file  for  later  analysis.  For  each  simulation  test  we  can 
select  variations  in  any  of  a  number  of  parameters.  However,  the  program 
itself  must  be  modified  to  change  the  amplitude,  period  or  form  of  the 
variation.  To  run  this  program  it  is  necessary  to  supply  a  file  con¬ 
taining  realistic  gyroscope  read-out  rates  (currently,  enough  for  15 
minutes  of  satellite  motion  with  a  spacing  of  0.5  seconds  between 
readouts),  and  a  mission  catalog  of  star  positions  (ordered  into  cells 
by  the  method  of  Appendix  3). 

To  begin  generating  data,  the  gyro  rates  and  the  table  of  star 
catalog  cell  positions  are  read  from  the  external  files.  Next,  we 
select  the  variations  we  wish  to  include  in  this  simulation.  The  earth 
and  satellite  orbit  constants  and  initial  positions  and  velocities  are 
specified  in  the  program  but  can  be  changed  if  desired.  These  orbit 
parameters,  along  with  our  assumed  geometry,  are  used  to  determine  the 
initial  orientation  of  the  vehicle  via  rotation  matrix  VN,  orienting 
the  vehicle  frame  relative  to  the  inertial  frame;  from  VN  we  recover 
the  initial  values  of  Euler  parameters,  3VN.  All  constants  for  this 
simulation  are  stored  in  the  first  record  of  the  data  file  (see  Table 
A10.1). 

We  are  now  ready  to  compute  image  coordinates  for  successive 
frames  of  data  (separated  by  30  seconds  of  satellite  motion  in  the  present 
software  version).  We  note  that  all  variations  such  as  gyro  biases 
and  coordinate  frame  perturbations  are  slowly  varying  and,  therefore, 
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the  perturbed  values  are  calculated  only  once  per  30  second  interval 
(subroutines  Bias  and  Perturb) .  For  each  frame  of  data  we  first 
integrate  forward  (via  subroutine  Runge)  the  kinematic  equation  for  3^ 
using  the  "true"  gyro  rates,  perhaps  including  a  perturbed  rotation 
matrix  VG,  found  from  and  used  to  rotate  the  gyro  rates  from  the 
gyro  frame  into  the  vehicle  frame.  Gaussian  noise  is  added  to  the 
integrated  values  of  3^  in  order  to  provide  an  "estimate"  of  3VN  to 
start  Process  B,  if  it  is  run  separately  from  Process  C  (see  description 
of  Combi n).  Euler  parameters  Bg^  which  can  be  time  varying  and 
rotation  matrix  BA,  relating  FOV(B)  with  respect  to  FOV(A),  are  deter¬ 
mined  at  this  time  also.  We  then  compute  the  position  and  velocity 
vectors  of  the  earth  and  satellite  (with  subroutine  Orbit)  and  find  the 
total  velocity  (which  is  later  used  by  subroutine  Access  to  add  stellar 
aberration  to  star  direction  cosines).  The  various  Euler  parameters 
and  total  velocity  are  saved  in  the  first  part  of  each  data  record. 

The  next  step  is  to  calculate  image  coordinates  for  stars  in  each 
FOV.  We  calculate  rotation  matrix  AN  (or  BN  for  FOV(B))  using  subroutines 
Dircosb  and  Mat-av,  and  use  the  last  row  as  the  boresight  unit  vector  of 
the  star  tracker.  This  unit  vector  is  used  by  Access  to  retrieve  a 
subcatalog  of  stars.  Each  star  is  then  projected  onto  the  focal  plane 
(via  Phoegn ) ;  if  it  lies  within  the  CCD  border,  we  save  its  position 
and  magnitude.  These  "true"  positions  are  then  perturbed  with  Gaussian 
noise  (subroutine  Gauss)  to  produce  "measured"  star  coordinates  (up 
to  10  stars).  The  steps  outlined  above  are  repeated  for  FOV(B). 

Both  the  true  and  measured  image  coordinates  and  magnitudes  are  saved  on 
the  data  file. 
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The  last  step  in  each  frame  is  to  add  noise  and/or  bias  values  to 
the  rate  gyro  data  (for  that  frame)  and  save  the  results  on  the  data 
file  (see  Table  A10.2).  Sufficient  space  is  left  between  the  end  of 
this  information  and  the  end  of  the  record  so  results  of  the  analysis 
of  Processes  B  and  C  can  be  saved  for  later  evaluation. 


Orbit 


Table  A10.1:  Format  of  First  Record  of  Simulation  File 


Variable 

Size 

Locations 

Satellite  orbit  major  axis 

1 

1 

G*(mass  of  earth) 

1 

2 

Initial  satellite  position 

3 

3-5 

Initial  satellite  velocity 

3 

6-8 

Earth  orbit  major  axis 

1 

9 

G*(mass  of  sun) 

1 

10 

Initial  earth  position 

3 

11-13 

Initial  earth  velocity 

3 

14-16 

Satellite  orbit  inclination 

1 

17 

Image  centroid  error  (1 -sigma) 

1 

18 

Image  magnitude  error  (1 -sigma) 

1 

19 

Euler  parameter  error  (1-sigma) 

1 

20 

Gyro  rate  error  (1 -sigma) 

1 

21 

Gyro  read-out  spacing 

1 

22 

Starting  time  (seconds) 

1 

23 

Frame  spacing  (seconds) 

1 

24 

Nominal  interlock  Euler  parameters 
Variation  amplitudes 

4 

25-28 

4 

29-32 

Variation  frequency  factors 

4 

33-36 

Nominal  gyro  biases 

3 

37-39 

Variation  amplitudes 

3 

40-42 

Variation  frequency  factors 

3 

\  43-45 

Nominal  interlock  Euler  parameters 
Variation  amplitudes  v 

4 

46-49 

4 

50-53 

Variation  frequency  factors 

4 

54-57 

Weight  for  apriori  Euler  parameters  gn. 
Standard  deviation  for  gyro  biases  M 

1 

58 

1 

59 

Process  C  !  Process  B  I 

Output  Data  I  Output  Data  Simulation  Program  Output  Data 
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Table  A10.2:  Format  of  Data  Records  of  Simulation  File 


Variable 

Size 

msm 

6vn  (true) 

4 

8 

1-4 

6vn  (estimated) 

4 

8 

5-8 

3vg  (true) 

4 

8 

9-12 

Bvg  (estimated) 

4 

8 

13-16 

4-> 

Bba  (true) 

4 

8 

17-20 

-M 

Bba  (estimated) 

4 

8 

21-24 

13 

CX 

4-> 

Velocity  components 

3 

8 

25-27 

o 

No.  stars  in  FOV(A) 

1 

8 

28 

1 0 

S- 

((x.y.m)}  (true) 

10  x 

3 

4 

29-58 

CJ> 

o 

{(x,y,m)}  (measured) 

10  x 

3 

4 

59-88 

CL 

No.  stars  in  FOV(B) 

1 

8 

89 

O 

{(x,y,m)}  (true) 

10  x 

3 

4 

90-119 

4-» 

to 

{(x,y,m)}  (measured) 

10  x 

3 

4 

120-149 

3 

E 

Rate  gyro  data  (on ) 

61 

4 

150-210 

on 

Rate  gyro  data  (gj2) 

61 

4 

211-271 

Rate  gyro  data  (aj3) 

61 

4 

272-332 

Gyro  biases  (true) 

3 

8 

333-335 

6vn  (talc . ) 

4 

8 

336-339 

*0 

Bba  (calc.) 

4 

8 

340-343 

Covariance  matrix  for  By^  (calc.) 

4  x 

4 

4 

344-359 

No.  stars  matched  in  FOV(A) 

1 

8 

360 

O  •♦-> 

3 

((x,y)>  (calc.) 

5  x 

2 

4 

361-370 

Qu  O 

No.  stars  matched  in  FOV(B) 

1 

8 

371 

((x,y)}  (calc.) 

5  x 

2 

4 

372-381 

BVN  (optimal  estimate) 

4 

8 

382-385 

4-» 

U  ig 

Gyro  biases  (optimal  estimate) 

3 

8 

386-388 

<3 

CO 

Bii&]  (integrated  from  previous 

CO  4-> 

VN  value) 

4 

8 

389-392 

U  Q- 

Covariance  matrix  for  8VN 

V  3 

a-  o 

(opt.  est.) 

4  x 

4 

4 

393-408 

l 


***•**•#*•**■*■***'-*****•*******************#**********#*#******•#**** 
*  * 

*  PROGRAM:  DATGEN  * 

*  # 
*#******##■**♦#*■**♦•***■**#■»***■***###***#*#**•##*#*##***#*#****#** 


80  !  This  program  computes  data  for  Processes  B  and  C.  Data  consist  of  Euler 

90  !  parameters,  assorted  other  parameters,  and  image  coordinates  for 

100  !  both  fields  cf  view. 

110  !  We  use  E-iler  parameters  in  this  version  to  orient 

120  !  the  7  frame  relative  to  inertia!  frame  and  FOV<B)  w.r.t.  FOV<A>. 

130  !  Tom  Stri < were  a. . . V. P. I .  &  S. U. .......  14  JANUARY  1981. 

140  ! 

150  OVERLAP 

160  OPTION  BASE  1 

170  FLOAT  !5 

180  DIM  An:3,3),Gn<3,3),Ba<3,3>,Bn<3,3),Av<3,3),Vg<3,3>,Vn<3,3) 

190  DIM  G1 :3>,  «:<3>,G3<3>,Bore<3> 

280  DIM  PsO<3>,Vs0<3>,Ps<3>,Vs<3>,L<3>,Lp<3>,Bias<3> 

210  DIM  PeU<3),Ve0<3),Pe<3), Ve < 3> , V< 3> , Vv< 3 > , Xn< 3 > , Voc<3> 

220  DIM  Bvn<4) , Dvnest < 4) , Bvg<4 ) , Bba<4> 

230  SHORT  ;<ym<  1  fi,  3)  ,  Xyt  <  1 0 , 3)  ,  Fov<  1 00,  4 > 

240  SHORT  3banDm<4> , Bi asnom<3) , Gyronom<3> , Bvgnom<4> 

250  SHORT  llvg ( 4 '  , Neg<4) , Eba<4> , Nba<4> , Ebi as<3> , Nbi as<3> , Egyro<3> , NgyroCc > 

260  SHORT  N1<23‘8>,W2<2048>,U3<2048>,R1<61>,R2<61>,R3<61> 

270  INTEGER  TaDle<529,2) 

280  RANDOMIZE 
290  ! 

300  Wread«=0 

310  Restart:  !  Come  here  to  do  another  run. 

320  PRINT  US  I N  3  "  K  "J"  PROGRAM  DATGEN  #######**###" 

330  ! 

340  NS="N" 

350  INPUT  'Do  you  uant  to  use  realistic  gyro  rate  history  <Y/N>?",Nt 

360  PRINT  IJSIN3  "/K,A";"Do  you  want  to  use  realistic  gyro  rate  history  <Y*,N|? 

" ;  h» 

370  ! 

380  IF  N*<  >"Y"  THEN  Plain_rates 

390  IF  Hread*l  1HEK  Star_cat 

400  PRINT  IJSIN3  "/k";"Place  disk  with  gyro  rates  <Fi 1  enamel 'Wtrue' >  in  :FS,1.. 
...then  push  CONT. " 

410  PAUSE 

420  ASSIGN  #1  TO  "k true: F8, 1 " 

430  DISP  "Reading  rate  gyro  hi  story. ...  PI  ease  wait." 

440  READ  #1 ;W1 O >,k2<*), W3<*> 

450  ASSIGN  #1  TO  * 

460  HreadM 
470  DISP 
480  GOTO  S;ar  rat 
490  “l 

500  Plain  ra;es:  ! 

510  Wread-0 
520  MAT  N1«ZER 


I  On#  rotation  every  90  minute* 


530  MAT  W2«<2*’1''5400> 

540  MAT  W3 *ZER 

550  I 

560  Star_cat:  ! 

570  PRINT  USINj  "/•k/K" ;  "PI  ace  star  catalog  disk  (Filenames:  'Tab22'  and  'Miss2 
20 ' )  in  :F8, l. . . ", ". . .then  push  CONT." 

580  PAUSE 
590  ! 

600  N**"N" 

610  INPUT  ’Has  Table  of  star  catalog  cell  positions  been  read-in  <YsN)?",N$ 

620  PRINT  USINj  "/k,A";"Has  Table  of  star  catalog  cell  positions  been  read-in? 

<Y/N>  M;N$ 

630  I 

640  IF  N<<  >"N“  THEk  Haue_table 

650  ASSIGN  *1  TO  HTab22:F8,I" 

660  READ  #1,1 

670  READ  #i;Taole<*>  !  Read  in  table  of  cell  positions. 

680  ASSIGN  #1  TO  *  i  Close  this  file. 

690  ! 

700  Have  table:  !  Come  here  if  table  has  been  read-in. 

710  ASSIGN  #1  TO  "ks s220:F8,l" 

720  ! 

730  Num=30  !  Number  of  records. 

740  Len-2048  1  Bytes/'record. 

750  Fn$="BCdat a: F8, 1 “  !  Dummy  file  name. 

760  INPUT  'File  naire  for  simulation  run  ('  S  i  mnnn:  F8,  1 '...  where  nnn  is  3  num.): 
“ ,  Fn* 

770  ON  ERROR  G310  Error 

780  PRINT  USINj  "</k/'K"  J  ”Fi  1  e  name  for  simulation  run  < 'Si  mnnn:  F8,  1 ' . .  .  wl  ere  nn 
n  i *  3  num.  ) ;  * , F*»<: 

790  ! 

800  Done:  ! 

010  ASSIGN  #2  TO  Fr* 

820  CHECK  READ  ¥2 

830  OFF  ERROR 

840  GOTO  OU 

850  ! 

860  Error:  I 

870  PRINT  USINj  "  rk  "  ;  ERRM* 

880  IF  ERRH055  THEN  STOP 

890  INPUT  'Shojld  I  create  this  file  for  you?",N* 

900  N  $  * " N " 

910  PRINT  USINj  "Should  I  create  this  file  for  you?  ",N$ 

920  IF  N$- *N"  THEN  STOP 
930  CREATE  Fn*,Mum,Len 
940  GOTO  Done 

950  I 

960  Ok:  ! 

970  READ  #2,1  I  Position  pointer  at  beginning  of  file. 

980  File-1 

990  « 

1000  Continue:  ! 

1010  I  Set  satellite  orbit  parameters. 

1020  *  See  write-up  on  "Orbit"  for  expl ai nat i on. 

1030  As-6652.56  !  Satellite  major  axis. 


101 


1040 
1050 
1060 
1070 
1080 
1090 
1100 
1 1  10 
1120 
1130 
1140 
1150 
1160 
1170 
1180 
1190 
1200 
1210 
1220 
1230 
1240 
1250 
1260 
1270 
1280 
1290 
1300 
1310 
1320 
1330 
1340 
1350 
1360 
1370 
1380 
1390 
1400 
1410 


Us=631 . 3487 
Us=Us*Us 
Inc  1 *75 

Ps0(  1  )’*As 
Ps0<2)-0 
Ps0<3>  =0 


G*M. 

Incl  is  satellite  inclination  in  degrees. 
Initial  position  of  satellite  (km). 


Vs0< 1 ) =0 

Vs0<2)=7. 74d6*C0S<  Inc  1  *PI/180)  !  Set  initial  satellite  velocity  (krr/sec). 

Vs0<3)  =7. 7  4ti6*S  INC  Inc  1  *PI'  180) 


Rs0=SQR<DOT<Pse,Ps0)) 

Vsi  =SQI?< DO T<  Vs£  ,  Vs0 ) )  !  Constants  needed  by  Orb i  t . 

Ds0=DOT<Ps3,VsC) 

As*l/(.2/Rs3- Vsi*Vsi  /Us) 

Period;=SQR(Ps/ls)*As*2*PI 

PRINT  USINI  Form4; "Period  : " , Per i od/60, "m i nut es “ 

i 

!  Set  parameters  for  earth  orbit. 

fte=l . 495973710E8  !  Earth  orbit  major  axis  (km). 

Ue*3. 642972685E5 
Ue*Ue*Ue 

Ve0=29 . 784S984E  !  Total  earth  velocity  (km/sec). 

Earth  i nc 1 *23.5 


Pe0<  1 ) 
Pe0(2) 
Pe0(3) 

Ve@ (  1 ) 
Ve0(2) 
Ve0(3) 


*-Ae 
s0 
=  0 


I 


Put  earth  at  vernal  equinox  for  initial 
position  (km). 


*Ve0  *C:0S  <  -Eart  h_ 
sVe0*SIN( -Earth 


i nc 1 *PI/180) 
i nc 1 *PI/180> 


Initial  earth  velocity  (I  m/sec). 
Earth  is  heading  downward  i r 
inertial  frame. 


Re0*SQR(DOT<  PeC ,Pe0)) 
Vei =SQR(D0r<  VeC , Ve0) ) 
De0=DOr<Pe3,Ve£ ) 

Ae  =  l/(.2/Re3-  Vei*Vei  /Ue) 


Constants  needed  by  Orb i t . 


1420  ! 

1430  C*3E5  !  C=Ve!ocity  of  light  (km/sec). 

1440  Del  =4 .  :348E -6  !  =  1  arcsecond  in  radians. 

1450  0mega*:2*P I /per i od  !  Angular  frequency  of  satellite  (rad/sec). 

1460  ! 

1470  !  Compute  various  Euler  parameter  values. 

1480  ! 

1490  !  Euler  parameters  relating  vehicle  and  gyro  frames. 

1500  MAT  Bvgnom*2ER 

1510  Bvgnom;i)=l  !  Nominal  values. 

1520  1 

1530  MAT  Evg*ZE? 

1540  N*-"N" 

1550  INPUT  'Do  ,>c»u  vant  variations  in  Euler  para,  relating  V  frame  to  Gyro  fram 
e  (V/N)?",N* 

1560  PRINT  USINi  "/k,A“;"Do  you  want  variations  in  Euler  para,  relating  V  frame 
to  Gyro  frame  ",N* 


102 


1370  IF  NS«'N"  THEN  Ho  vg 
1580  Evg<  1  >iSDel 

1590  Evg<2)*-2*0«1  I  Amplitude  of  variations  (radians). 

1600  Evg(3)«3*D»1 

1610  Evg(4)*4*D»l 

1620  I 

1630  Nvg(l)=3 

1640  Hvg(2);i4  !  Frequency  of  variations. 

1650  Nvg(3)-5 

1660  Nvg(4)’=6 

1670  ! 

1680  No_vg:  ! 

1690  !  Compute  the  orientation  of  FOV(B)  w.r.t.  F0V(A>. 

1700  ' 

1710  Bbanom:i)al/'SQF<2>  !  SQR(  1/'S0R<2>  +  1  V2 

1720  Bbanom  :2>  =  1'  SQF  (2),  !Bbanom(l)  1  Nominal  values. 

1730  Bbanom :  3  )  =  3  !  l'(SQR(2)*4*Bbanom( 1 ) ) 

1740  Bbanom(4)=3  !Bbanom<3> 

1750  ! 

1760  MAT  Eb  »=2E  ? 

1770  NS="N" 

1780  INPUT  'Do  /ou  uant  variations  in  Euler  para,  relating  B  frame  to  A  frame  < 
Y/N>?",N$ 

1790  PRINT  USINj  "Do  you  want  variations  in  Euler  para,  relating  I  frame 

to  A  frame  (Y/N)?  " , NS 
1800  IF  N S  =  ' N "  THEN  No_ba 
1810  Eba(  1  >!S10*O«  1 

1820  Eba(2):=-30*Iie)  !  Amplitude  of  variations  (radians). 

1830  Eba(3)=20*Dt 1 

1840  Eba<4)«5*D?l 

1850  ! 

1860  Nba(l>*2 

1878  Nba<2>!«3  !  Frequency  of  variations  < Osc i 1 1 ai ons^orb i t ) . 

1880  Nba<  3  )  ;=5 
1890  Nba<4)«4 

1900  ! 

1910  No_ba:  ! 

1920  !  Set  gyro  bias  values. 

1930  MAT  Bi  isr.on=  2ER 
1940  MAT  Ebias*2E:R 
1950  BiasS- 'N" 

1960  INPUT  'Do  A'U  uant  time  varying  gyro  biases  (Y'N)?  ", BiasS 

1970  PRINT  IJSIN3  "/K,K"; "Do  you  want  time  varying  gyro  biases  (Y/N)?  ", BiasS 

1980  IF  B  i  a:»  S  -  ”  4 '  TFEN  No  bias 

1990  ! 

2000  Bi asnom( 1 ) *-Del 

2010  Bi  asnom<2>  =I:*De  1  !  Nominal  values  for  biases  (r adi ans^sec ) . 

2020  Bi asnom(3) *- 3*Ie 1 
2030  ! 

2040  Ebi  as(  l  )-Bi  asncm(  1  )/'2 

2050  Ebi  as(:’)*-Bi  asr  om(2)/3  !  Amplitude  of  variations  (radi ans^sec ) . 

2060  Ebi  as<3)>Bi  asncm<3)/'4 
2070  ! 

2080  Nbi as( l )*4 

2090  NbiasC2>»6  I  Frequency  of  variations  (Osc i 1 1  at i ons/orbi t ) . 
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2100  Nbias(3>«8 
2110  ! 

2120  No  bias:  !  Set  various  constants. 

2130  ! 

2140  Sigxy*3.4E-3  !  Standard  deviation  of  image  coordinates  in  mm. 

2150  Sigm*.05  !  Sigm  is  the  deviation  in  magnitude. 

2160  ! 

2170  Xynoi  &<>$*"  i” 

2180  INPUT  'Do  you  uant  to  add  noise  to  image  coordinates  <Y/N>?" , Xynoi set 
2190  PRINT  USINj  "/K,A";"Do  you  want  to  add  noise  to  image  coordi nates(Y  N>?",: 
ynoi set 


2200  IF  Xynoi se»* "N"  THEN  Sigxy»0 
2210  ! 

2220  F1«72.425  !  Focal  length  of  star  sensor  lens  <mm>. 

2230  Sigb*Pl/183  !  Standard  deviation  in  Euler  parameters.  This  is  used 

2240  !  if  Process  B  is  to  run  separately. 

2250  ! 

2260  SiggyM  !  Ste.ndard  deviation  of  gyro  noise  (degrees/hour  > . 

2270  Si ggyBSi ggy*PI^ < 180*3600)  !  Crad. /second) 

2280  1 

2290  Gyro*«'N" 

2300  INPUT  'Do  /c<u  uant  noise  added  to  rate  gyro  dat a< Y/N>?" , Gyr o* 

2310  PRINT  USINj  "/K ,  A" ; "Do  you  want  noise  added  to  rate  gyro  data  (Y/N) 7 " , Gyr( 

* 

2320  IF  Gyro$*“ 4'  TFEN  Siggy=0 
2330  ! 

2340  Sigma*0 

2350  Radi  us;*6*P  I  /  18C  !  Angle  from  FOV  center  for  accepting  catalog  stars. 

2360  < 

2370  PLOTTER  IS  'GRAPHICS" 

2380  LORG  5 
2390  ! 

2400  !  Get  the  initial  gyro  orientation  w.r.t.  the  inertial  system. 

2410  ! 

2420  T0=0  !  Set  reference  time. 

2430  Time=0  !  Set  initial  time  (seconds)  for  this  run. 

2440  ! 

2450  CALL  Orb i t  <T i me , Ps<* ) , Vs<* > , Ps0< *> , Vs0< *) , T0, Us , As , Ds0, Rs0 > 

2460  PRINT  USINj  For m 1 ; "Pos i t i on  <km)  and  velocity  (km/sec)  of  Sat e 1 1 i te! ", Ps O 
), Vs<«) 


2470 

2480 

2490 

2500 

2510 

2520 

2530 

2540 

2550 

2560 

2570 

2580 

2590 

2600 

2610 


Sc*SQR;DOT(Ps,Fs)>  ! 

MAT  G3*Ps/<Sc)  ! 

CALL  Cross  <G2 <*),G3<*),Vs<#))  ! 

G2*SQR  ;D0T<(I2,C2)  )  ! 

MAT  G2‘*G2/«;2)  ! 

CALL  Cross <Ci  1<*>,G2<*),G3<*>)  ! 

( 

FOR  I  * l  TO  3  ! 

GnU  ,  I>= jl <I> 

Gn<2 , I  >■  j«!<I  > 

Gn<3 ,  I)«;:i<I) 

NEXT  I 

! 

PRINT  USINj  Form2;  "Matrix  GN:",Gn<* 


Normalize  the  satellite  positior. 

G3  is  along  position  vector. 

G2  is  normal  to  orbit  plane  defined 
by  position  and  velocity  vectors. 
Normal i ze  G2. 

G1  ■  G2  cross  G3. 

Fill  the  Gn<*)  rotation  matrix. 
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2620  ' 

2630  I  Compute  Euler  parameters  for  VN  rotation. 

2640  !  First  get  true  Euler  parameters  for  VC  rotation. 

2630  1 

2660  CALL  Pert  u~b<  B’.  gnom<  *),  Eug<  *>,  Nug<  *>,  Omega,  0,  Bug(  *>  ) 

2670  PRINT  USING  Form3; "Bug. . . nomi nal  Euler  Parameters  between  frames  V-C : " , Bug 
nom( 

2680  PRINT  USING  Form3; "Bug. .. true  Euler  Parameters  between  frames  V-G:",BvgC*> 
2690  ! 

2700  CALL  Btrcoib(Bug<*),Vg<*>) 

2710  ! 

2720  MAT  Vn*Vg*Gr. 

2730  !  Recouer  Euler  parameters. 

2740  Bun<l>  ».5*3£!R<Vn<l,  1>+Vn<2, 2>+Vn< 3, 3>  +  l  > 

2750  B0*Bun:i) 

2760  Bun<2):* CVnCl:,  3>-Vn<3, 2)  )/'<4*B0) 

2770  BvnOOCVnC:, 1 >-Vn< 1 , 3) OC4*B0> 

2780  Bun<4)  *<Vn<  1 ,2>-Vn<2,  1>>/<4*B0> 

2790  ! 

2800  PRINT  USING  For  m3 ; " Bun . . . In i t i al  Euler  Parameters  between  frames  V-F : " , Bun 
<*> 

2810  » 

2620  ! 

2830  Step=30  !  seconds  between  frames. 

2840  Belt*. 3  !  seconds  between  gyro  readouts. 

2850  ! 

2860  1  Sa'.e  all  constants  for  this  run. 

2870  PRINT  42,  1  As ,  l s ,  Ps0< * ) ,  Vs0< * ) ,  Ae ,  Ue ,  Pe0 ( * ) ,  Ve0< * > ,  Incl , S i gxy , S i gm , S i gb, S i 
ggy , Be  1 1 , T i me , St  ?p 

2880  PRINT  42;  Boanotr  <*>  ,  EbaC*  > , NbaC*) , Bi  asnomC*  )  , Eb i as C * > , Nb i as <  * > ,  Bvgnoit  (*> , Eu 
gC  *  )  , NugC  * ) 

2890  ! 

2900  !  Nou  generate  frames  of  data. 

2910  I 

2920  Time  loop:  ! 

2930  1 1*0 

2940  FOR  It'*2  T3  30  !  number  of  frames. 

2950  ' 

2960  BISP  ’  FR3ME:  It 

2970  ! 

2980  PRINT  USI  TC;  "✓  K ,  DD,  K  "  ;  "  **********  FRAME  :  "  ,  1 1 ,  "  ***********" 

2990  1  Loop  over  time  interual  to  get  true  gyro  rates. 

3000  FOR  J>*1  T 3  Step/Belt  +  1 

3010  R 1 <  7  >»W1 < I i +  J ) 

3020  R2C J)=W2< I i+J> 

3030  R3< J>*W3< I i ♦ J> 

3040  NEXT  J 
3050  ! 

3060  I i*I i rSteo' Be) t 
3070  Bt*Tiwe-T3 

3080  !  Compute  the  VG  Euler  parameters. 

3090  CALL  Per t  ,ir  bC I vgnomC *), EvgC *>,  NvgC *>,  Omega,  Dt ,  BvgC *>  > 

3100  CALL  3i rc os bCIugC*) , Vg<») > 

3110  PRINT  USHC,  Fcrm2;  "Matrix  VG:",Vg<*> 

3120  !  Call  Runge-Kutta  to  compute  true  ualues  vehicle  frame.  tWe 


3130  !  keep  VG  fixed  during  this  time  interval.) 

3140  CALL  l?ung»<  Bvr  <♦>  ,  Ti  me,  Del  t ,  St  ep,  Rl  (*>  ,  R2<*>  ,  R3<*>  ,  Vg(*>  > 

3150  ! 

3160  PRINT  USHCi  Fc rm4 ; " Sat e 1 1 i t e  time  from  start  of  simulation:  " , Ti me, "sec on 
ds*' 

3170  PRINT  USHCi  Fcrm3; "Bun. .. True  Euler  Parameters  between  frames  V-N:",Bvn(* 
) 

3180  ! 

3190  CALL  )irc3sb<Iun<*),Vn<*)) 

3200  !  Perturb  BetaCBA)  about  their  nominal  values. 

3210  CALL  Pert jrbCIbanomC #>, Eba< *), NbaC *>, Omega, Dt , Bba<*> ) 

3220  CALL  3i rc  osbCIbaC*) , Ba<*) )  !  Compute  rotation  matrix. 

3230  ! 

3240  PRINT  USHCi  Fcrm3; "Bba. . . Nomi nal  Euler  Parameters  between  frames  B-A:".Bb 
anom<*) 

3250  PRINT  USHCi  Fc rm3 Bba. .. True  Euler  Parameters  between  frames  B-A:",Bba<* 
) 

3260  ! 

3270  CALL  :DirCD«.b<Iba<*>,Ba<*>) 

3280  ! 

3290  PRINT  USHCi  Fcrm2;  "Matr  i  x  BA  :",Ba<*> 

3300  ! 

3310  CALL  Hat_av<B«.<*  >  ,  Av<  *)  ) 

3320  !  Conpute  AN  rotation  matrix. 

3330  MAT  An*Av*Vn 

3340  !  Upcate  the  satellite  and  earth  position. 

3350  CALL  Orbi  t  <  T  i  rr  e  ,  Ps  <  *  )  ,  Vs<  *  )  ,  Ps0<  *  >  ,  Vs0  <  *  )  ,  TO  ,  Us  ,  As ,  Ds0,  Rs0  ) 

3360  CALL  Orbi t <  T i « e , Pe < * ) , Ve < * ) , Pe0< * > , Ve0< * > , T0 , Ue , Ae , De0, Re8 ) 

3370  ! 

3388  PRINT  USHCi  Fermi ;  "Posi  t  i  on  (km)  and  velocity  (km/sec)  of  Sat  e  1  1  1 1  e  :  “  ,  Ps  < 
*), Vs<*> 

3390  PRINT  USHCi  Fermi ;  "Posi  t  i  on  (km)  and  velocity  (km/iec)  of  Ear  t  h:  "  ,  F  e  <  *  > ,  V 
e  <  *  ) 

3400  ! 

3410  MAT  V*7s+V»  !  Compute  total  velocity. 

3420  ! 

3438  PRINT  USINj  For  ml ; " Tot al  velocity  of  satellite  <k m/sec > : " , V ( * > 

3440  ! 

3450  Mag*SQR(DOr <  V, V  >  > 

3460  MAT  Voo-V/CC) 

3470  • 

3480  FOR  1=1  TO  <  !  Perturb  Euler  parameters. 

3490  CALL  GaussCSi gb, Bvn< I ) , Bvnest < I > >  !  These  are  used  if  only  Proc.  B 

3500  NEXT  I  1  is  run. 

3510  ! 

3520  Mag=SQR< DO T< Bvrest , Bvnest ) )  !  Normalize  Euler  parameters. 

3530  MAT  Bvnest  sI:vnest/<Mag) 

3540  ! 

3550  F i l e*F i 1 e+ 1 


3560 

PRINT 

42, Fi le 

1  Position  file  pointer. 

3570 

PRINT 

42;  Bv>ri<*> 

!  Save 

true  Euler  parameters. 

3580 

PRINT 

42; B jnest  <*> 

1  Save 

estimated  Euler  parameters. 

3590 

PRINT 

42; Bvg<  *) 

!  Save 

Betas  for  frame  G  to  V:lvg. 

3600 

PRINT 

42;Bvg<«> 

!  Save 

estimated  Bug. 

3610 

PRINT 

42; Boat*) 

!  Save 

Betas  for  frame  A  to  B  -  Bba 
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3620  PRINT  42;Boa<*>  \  Save  Bba(est.>. 

3630  PRINT  ♦2;V<*)  !  Save  velocity  vector. 

3640  I 

3630  GCLEAR 

3660  LOCATE  10,110, 50, 100 
3670  I 

3680  Pa*»*0 

3690  Pass  2:  !  Come  here  for  F0V<B> — Second  pass  through  loop. 

3700  “  ! 

3710  SHOW  -3.7, 5. 7, -4. 4, 4. 4 
3720  CLIP  -3.7, 5. 7, -4. 4, 4. 4 
3730  FRAME 
3740  AXES  1,1, 0,0 
3750  ! 

3760  FOR  JM  TO  3 

3770  Bore ;  J)*3n<3, J)  !  Boresight  direction  cosines. 

3780  NEXT  J 
3790  ! 

3800  PRINT  NS  INI  For  m2; "Matr i x  AN : " , An  <  *  > 

3810  PRINT  IJSIN:  Form2; "Boresi ght  unit  vector! ", Bore<*> 

3820  ' 

3830  CALL  Access*  #1 , Fov(*>,Nf ov, Bore  <  *> , Si gma, Radius, Fid, Table<*>, Voc  <  *) ) 
3840  ! 

3850  Nm-0 

3860  PRINT  IJSIN:  For m4 ; "Number  of  stars  from  the  catal  og!  "  ,  Nf  ov 

3870  MAT  Xy;=ZE? 

3880  MAT  Xyw=ZE  ? 

3890  ! 

3900  FOR  N* l  TO  Mfov  !  Find  stars  that  are  within  FOV. 

3910  FOR  1*1  TO  3 

3920  L< J>»F5V<N, J) 

3930  NEXT  J 

3940  CALL  Pho?c|n(l(*),An<*),Xx,Yy)  !  Compute  x,y. 

3950  Xx*X:<*F  1 

3960  Yy«Yv*F 1 

3970  IF  A3S<X<:>5./  THEN  Skip  !  Test  for  star  in  field. 

3980  IF  A3S<Y^:>4.4  THEN  Skip 

3990  ! 

4000  Nm*Nm+l  !  Got  one  I 

4010  Xyt  <Nm, 1 >s  Xx 

4020  Xyt  <Nm, 2 )*Yy 

4030  CALL  Gauss <Sigxy,0,X>  !  Apply  noise  to  positions. 

4040  Xym<Hm,  1  >l:Xx-»X 

4050  CALL  Gauss <Sigxy,0,Y> 

4060  Xy»<Hm,  2)*:Yy+ Y 

4070  Mt*Fov(N, 1  ')  !  Save  the  magnitude. 

4080  Xyt<Nm,3)*Mt 

4090  CALL  Gauss (Si gm, 0, Dm)  !  Add  noise  to  magnitude. 

4100  Xym(Mm,  3 )«'Mt  ♦Dm 

4110  ! 

4120  MOVE  XymCMw, 1 ) , Xym(Nm, 2) 

4130  LABEL  USING  !  Plot  the  star  position. 

4140  IF  Nm*10  THEh  Output 

4150  Skip:  ! 

4160  NEXT  N 
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4170  ! 

4180  Output:  ! 

4190  PRINT  USINj  For m4; "Number  of  stars  in  this  F0V:",Nm 
4200  PRINT  USINj  Form2; "True  image  coordinates  (mm):  ",Xyt(*> 

4210  PRINT  USINj  For  m2; "Measured  image  coordinates  (mm) : " , Xym( * ) 

4220  ! 

4230  PRINT  42; Nn  !  Saue  number  of  stars  in  fielc. 

4240  PRINT  42; X^t <*> , Xym<* >  !  Saue  true  and  measured  positions. 

4250  ! 

4260  MPT  Bn*Ba* 3n  !  Rotate  to  F0V(B>. 

4270  MPT  Pn:=Bn 

4280  LOCPTE  10, 110, C, 50 

4290  ! 

4300  Pass*P iss+ 1 
4310  IF  Pas**l  THEN  Na*Nm 

4320  IF  Pass*!  THEN  Pass_2 

4330  ! 

4340  IF  Gyro**“4'  THEN  Skip_noise 

4350  DISP  "Pdditci  nc  i  se  to  gyro  rat  es ...  p  1  ease  wait." 

4360  !  ’ 

4370  FOR  J*l  TO  Step/Delt 
4380  CPLL  Caus* (S i ggy, 0, X) 

4390  R1  <J>=R1  <„>+>■ 

4400  CPLL  Gauss ( S i ggy , 0, X) 

4410  R2(  J  >=R2  (,.')+>■ 

4420  CPLL  Gau ss (Si ggy , 0, X) 

4430  R3(  J  >=R3(.  >+>■ 

4440  NEXT  J 
4450  ! 

4460  Skip_noise:  ! 

4470  IF  Bias**" 4'  THEN  Skip_bias 

4480  !  Calculate  the  bias  rates. 

4490  CPLL  Bi as< Dt , Bi asnom<*> , Ebi as(*> , Nbi as(*> , Omega, Bi as(*> ) 

4500  PRINT  USING  Form3; "Bi ases. . . true  ual ues: " , Bi as(*> 

4510  MPT  R1  =RH  (Bi  as(  1  )  ) 

4520  MPT  R2*R2t <Bias<2)> 

4530  MPT  R3*R3t<Bias<3)> 

4540  Skip_bi as:  ! 

4550  ! 

4560  OUTPUT  0  USING  "K, DD, K, DD, XX, DD" ; "Frame:  ",It,"  Number  of  stars:  ",Ha,Nm 

4570  DISP 

4580  ! 

4590  PRINT  42;  R1  <  *) ,  R2(*>  ,  R3(*>  *  Saue  measured  gyro  rates  (60*3) 

4600  PRINT  42 ; B i as ( * )  !  Saue  true  bias  values  <3>. 

4610  ! 

4620  NEXT  I; 

4630  ! 

4640  PSSIGH  *  TO  *2 
4650  ! 

4660  N**"N 1 

4670  INPUT  "Do  you  want  to  do  another  run(Y/N>?" , N* 

4680  PRINT  USHCi  "rK,K";"Do  you  want  to  do  another  run(Y/N>?  ";N* 

4690  IF  N#«"Y"  THEH  Restart 
4700  I 

4710  Forml :  IMP  jE!  K/3(3(MD.  DDDDE,  XV> 
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Combi n 

This  program  analyses  data  produced  by  simulation  program  Datgen, 
directing  the  data  to  subroutines  for  Process  B  (Proc-b)  and  Process  C 
(Orbit,  Runge  and  Kalman).  Process  B  and  Process  C  can  be  run  separ¬ 
ately  (Process  C  alone  only  if  Process  B  was  run  previously  with  these 
data)  or  they  can  be  run  together.  Combi n  requests  several  parameters 
from  the  user:  1)  the  process  noise  standard  deviation  associated  with 
the  variation  in  interlock  Euler  parameters,  Bg^»  used  in  Kalman  filter 
update  of  3gA  (see  Section  3  of  the  Final  Report),  and  2)  the  gyro  bias 
"standard  deviation"  which  controls  the  variations  in  the  recovered  gyro 
biases  (see  Section  4  of  the  Final  Report).  In  addition,  we  can  also 
offset,  by  a  constant  amount,  the  interlocks  between  the  vehicle  and 
gyro  frame  (nominally  set  to  zero). 

The  data  frames,  read  from  an  external  file,  are  processed  one  at  a 
time.  For  each  frame,  the  Euler  parameters,  ByN,  and  the  associated 
covariance  matrix  from  analysis  of  the  previous  frame,  are  integrated 
forward  by  subroutine  Runge  (for  the  first  frame  we  can  use  the  true 
values  for  3yG  or  some  offset).  Subroutine  Orbit  computes  the  position 
and  velocity  of  the  earth  and  satellite  (the  total  velocity  is  used  by 
Access  to  add  aberration  effects  to  the  star  direction  cosines).  We 
then  call  Proc-b  to  1)  match  measured  stars  with  specific  catalog  stars 
and  2)  update  the  Euler  parameters  By^  and  Bg^  via  least-squares  cor¬ 
rection.  These  Euler  parameters,  the  covariance  matrix  associated  with 
BVfj.  and  the  calculated  image  coordinates  for  all  matched  stars 
are  saved  by  storing  them  at  the  end  of  the  current  data  record. 


i 
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Subroutine  Kalman  is  then  called  to  combine  the  integrated  values 

for  $ull  with  the  corrected  values  from  Process  B  analysis  to  yield  an 
VN 

"optimal  estimate"  of  0VN  and  the  gyro  biases,  at  the  current  time. 
These  parameters  and  the  4x4  covariance  matrix  associated  with  the 
estimate  of  BVN  are  saved  on  the  data  file  also. 
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I************'******-******************************************** 
*  * 

*  PROGRAM:  COMBINE  * 

*  * 
************  ****  *♦•■*#«*■*****•**■»***#****■***#♦*****•**#********### 


80  !  T.  STR! 

90  !  This  pro; 

100  I  Euler  pa' 

110  !  This  pro; 

120  !  FOVCJ>  a' 

130  ! 

140  OVERLAP 

150  FLOAT  5 

160  OPTION  BASE 

170  DIM  PsO<3>, 

180  DIM  T 1  :4>, 1 

190  DIM  Cov8<8, 

200  DIM  Bvn<  4 )  , 

210  DIM  Bba< 4 ) , 

220  SHORT  Xyma( 

230  SHORT  Cov<i 

240  DIM  Pk  '.7,7) 

250  DIM  Xk:<7>, 

260  COM  Vg  1 3, 3) 

270  RAD 

280  ! 

290  PRINT  USI 

M 

300  ! 

310  N*“" N" 

320  INPUT  "D: 

330  PRINT  USI 

340  Pb-0 

350  IF  NT="Y" 

360  » 

370  N<*"N" 

380  INPUT  "D: 

390  PRINT  USI 

400  Pc  *0 

410  IF  Nl'T 


IKWERDA  .  14  JANUARY  1981. 

gram  combines  processes  B  and  C  oT  Star  Wars.  This  versior  uses 
"ameters  relating  the  "V"  frame  to  the  inertial  frame, 
gram  also  recovers  the  Euler  parameters  relating  FOV<A>  tc 
id  tke  gyro  bias  estimates. 


■s0<3),Ps<3>,Vs<3), Pe0<3> , Ve0<3> , Pe(3>,Ve<3> 
:<3, 3) 

:> 

!vntrue<4) ,Bvg<4>,Bvns<4> 
i:batrue(4),Voc<3),Bbae<4),Bbalsq(4) 
l0,2),Xymb<10,3),Xyca<5,2),Xycb<5,2>,Xyt<10,3) 
,4),W1(61),W2(61),U3(61), Short 
,  Lao  <7, 7) 

•:ki  <7>,Xkb<7>,  Q< 3, 3 ) , Qba<4, 4 > , Pba< 4 , 4 > 

,  INTEGER  Tabl e<529(  2) 


IMG  "K"; "##############*###*##  PROCESS 


oing  Proc  B  <Y/'N)?",N* 

IMG  VK,  A";  "Doing  Proc  B  (Y/'N)?  " ,  N* 

"  THEN  Pb-1 


5 i ng  Proc  C  <Y/'N)7",N$ 

IMG  U/K,  A"; "Doing  Proc  C  <Y^N>?  ",N* 

“  THEN  Pc  *  1 


AND  C 


IF  Pb*0  THEN  Hawe_t abl e 
! 

PRINT  USING  "K"; "Insert  star  catalog  disk  into  F8,l....Then  press  CONT" 
PAUSE 

N$»"  "  !  Set  answer  to  blank. 

INPUT  "H»i  tke  table  of  star  cell  positions  been  read-in?", N$ 

PRINT  USING  n/'K,K";  "Has  cell  table  been  read-in?  " ,  N* 

IF  N><>"r  TEEN  Have  table 
! 

ASSIGN  #1  TO  "Tab22: F8, 1 " 

READ  §1,1 


540  READ  «i;  r<ib1c<*>  !  Read  in  table  of  cell  positions. 

550  ASSIGN  •  TO  «1  I  Close  this  file. 

560  ! 

570  ASSIGN  #  2  TO  "Mss220:  F8,  1"  !  Star  catalog  file. 

580  ! 

590  Have_table:  !  Cc me  here  if  this  is  a  cont i nuat i on. 

600  INPUT  "I'tput  file  name  and  device  with  simulation  data  (Si  mnnn:  F8, 0) :  " ,  D 

i  n* 

610  PRINT  USING  "/K, KM Input  file  name  and  deuice  with  simulation  data:  ",D 

i  n* 

620  ASSIGN  ttl  TO  Din* 

630  !  BUFFER  #1 

640  CHECK  RETD  HI 

650  ! 

660  READ  #1 , 1 ; As, Us, Ps0(*>, Vs0(*> , Ae, Ue, Pe0< *> , Ve0(*> , Inc  1 , Si gxy, Si gm, Si gb, S 

i  ggy, Del t , Ti me, St« p 

670  PRINT  USING  "•'K,  DDDDD" ;  "Satel  1  i  te  orbit  major  axis  <km>:  "  ,  As 

680  PRINT  USING  "K, D. DDDDE" ; "Earth  orbit  major  axis  (km):  ",Ae 

690  PRINT  USING  "K, DDDDD" ; "Satel 1 i te  orbit  inclination  (deg. > : " , Inc  1 

700  Si  gxu*MA><<  Si  cxy,  IE-3) 

710  PRINT  USING  "K, DD. DD" ; "Rate  gyro  data  spacing  (sec):  ",Delt 

720  PRINT  USING  "K, DD . DD" ; "Runge-Kut t a  time  step  (sec):  ",Step 

730  PRINT  USING  "K, D. DDDE" ; “Gyro  standard  deviation  (rad/sec):  ",Siggy 

740  ! 

750  Si  ggv*MA><<  S i  cgy ,  2. 424E-6)  !  Must  keep  gyro  std.  dev.  non-rero. 

760  ! 

770  Ds0*.)OT(3.‘0,Vs0) 

780  RsO=SQR(  DC<T(F  s0 ,  Ps0) )  !  Constants  for  orbit  calculation. 

790  De0«:)OT(  0,Ve0) 

800  Re0=>SQR(  DOT (Fe0,Pe0)) 

810  T0=0  !  Set  reference  time. 

820  ! 

830  RED  I II  Ml  (33) 

840  READ  #1; Jl<*)  |  Read  all  the  perturbation  constants. 

850  ! 

860  FOR  1*1  10  4 

870  Bbanom( I )=H1 ( I )  !  Retrieve  the  nominal  interlock  values 

880  NEXT  1  !  from  this  list. 

890  ! 

900  REDII1  Ml  (61) 

910  ! 

920  IF  Pb=0  THEN  READ  #i;Mba  !  Read  the  weight  for  interlock  recovery. 

930  IF  Pb=0  THEN  Ski  pi 

940  ! 

950  INPUT  "  I  *»put  weight  in  arcseconds  for  interlock  variance  (2, 5,  et  c  .  > " ,  Mba 

960  PRINT  USING  "rK, DD. DDD" Input  weight  in  arcseconds  for  interlock  varian 

ce  (2, 5, etc . >  ", 4ba 

970  PRINT  ill ;  Mba 

980  MAT  Pba*»IHN  !  Set  up  interlock  Kalman  filter  matrices. 

990  MAT  Pba**ba*( IE-6)  !  Set  covariance  matrix  to  large  initial  value. 

1O08  ! 

1010  MAT  Gba-IUN 

1020  Qba( l, l)»l/8 

1030  0ba<i,2)-l/€  f 

1040  Qba<2, 1 ) *■  l/€  !  Oba  is  the  process  noise  matrix  for  the 


114 


1050  Qba(2,  2)  ■!  '8  I  interlock  angles  between  FOV(A)  and  FOV(B). 

1060  Clba(  3,  3>  »1  '4  !  The  Q  matrix  has  been  converted  to  Euler 

1O70  Qba(4, 4 ) »1 ^4  !  parameters.  NOTE:  This  matrix  is  valid  for 

1080  MAT  Oba* 3ba*( (Wba*4. 848E-6) A2)  !  (3,1,3)  rotation  of  (0,90,0)  onlyl 

1O90  MAT  Pba*3ba  !  Can  start  with  good  estimate. 

1100  ! 

1110  Sk i pi :  1 

1120  W*1EI  !  SQK(Weight)  for  constraint  equation. 

1130  ! 

1140  IF  P.:*0  THEN  Skip2 
1150  ! 

1160  INPUT  "Input  Gyro  B i as  Standard  Deviation  (Degrees^Hr) " , Si gbi as 

1170  PRINT  USING  M/K, DD. DD" Input  Gyro  Bi  as  Standard  Deviation  (Degrees/Hr 

)  " , Sigbias 

1180  PRINT  #1 ;  Si gt i as 

1190  Si gb i as* 5i gb i as*PI/( 180*3600 )  !  Convert  to  radians/sec. 

1200  ! 

1210  MAT  Lam*  ZE  R 

1220  FOR  1*5  TO  7 

1230  Lam( I , I : *Si gbi asA2  !  Set  observation  covariance  matrix  for  gyre  bias. 

1240  NEXT  I 

1250  ! 

1260  MAT  Pk  =  I  DM 

1270  MAT  Pk=P<*( 1 E  — 7 )  !  Set  covariance  to  large  value. 

1280  ! 

1290  Qfac=SiggyA2 

1300  MAT  Q  = I D  T 

1310  MAT  •J*Q*(C<fac)  !  Initialize  process  noise  matrix. 

1320  PRINT  USING  Form3;"Q  Mat r i x : " , 0 ( * > 

1330  ! 

1340  MAT  3vg=ZER 

1350  Bvg(l)*l 

1360  NS*" H " 

1370  INPUT  "Do  yov  want  to  offset  matrix  VG  CV-frame  to  Gyro  frame)", HI 
1380  PRINT  USING  "/K,K"; "Do  you  want  to  offset  matrix  VG  ( V-fr ame  to  Gyro  fra 
me)  " J  NS 
1390  ! 

1400  IF  N S * " N "  THEN  GOTO  Sk i pvg 

1410  Bvg(l)»J 

1420  Bvg(2)*lE-2  !  Size  of  offset  can  be  changed. 

1430  Bvg(3) ’* 2E-3 

1440  Bvg(4)  *JiE-2 

1450  Mag*SQ?< DOT (Bvg, Bvg) )  >  Re-normal ize  Euler  parameters. 

1460  MAT  Bvg* Bvg/(Mag) 

1470  Sk i pvg:  ! 

1480  CALL  D i r :osb(Bvg< *) ,Vg(*>,0, T2(*), T2(*), T2(*>, T2(*)) 

1490  PRINT  USING  Form3; "Matr i x  VG  for  this  run:“,Vg(*> 

1500  ! 

1510  Sk i p2:  ! 

1520  ! 

1530  C*3E5  !  Speed  of  light  (km/sec). 

1540  Pa»s>0  !  First  pass  through  frame  loop  -  special  case. 

1550  Tk*Time  !  Initial  time. 

1560  MAT  Xk  i  *  ZI.R 

1570  MAT  Xk  t * ZER 
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1580  ! 

1590  !  +  +  H+  +  4+  +  +  Begin  Loop  Over  Data  Frames.  +  +  ♦  +  +  +  +  ♦  +  ♦  +  ♦♦ 

1600  ' 

1610  FOR  Ifile*2  TO  30  !  Loop  over  all  data  frames. 

1620  PRINT  USING  ‘VK,DDD,K" ;  "*****'***  RECORD  NUMBER;  ",Ifile,  *•  A»  <V  A*  At  A  *V  A*  <V  " 
1630  Pass-=Pas»Hl  ”*  ” 

1640  ! 

1650  READ  #1, Ifi le 

1660  READ  «1 ;  Bontrue<*> 

1670  PRINT  USING  Forml ; "Bon. . . . True  Euler  parameters  between  V  and  N  frames:" 
, Bvntrue<*> 

1680  RED  III  Xkt<4> 

1690  MAT  Xkt  =  Bunt  rue 

1700  REDIM  Xkt<7> 

1710  IF  Piss=l  THEN  MAT  Xki=Xkt  !  This  causes  displacement  of  first  estimate. 

1720  ! 

1730  READ  #l;Bun<*>  !  These  are  not  used  unless  we  do  Proc.  B  only. 

1740  !  PRINT  USING  F orm 1 ; " Bon . . . . Es t i mat ed  Euler  parameters  between  V  anc  N  fra 
mes: " , Bon<*> 

1750  ! 

1760  READ  #l;Bvg(4)  !  True  Euler  parameters  between  V  and  G  frames. 

1770  !  CALL  Dircosb<Bog<*),Vg<*),0,T2<*),T2(*),T2t*>,T2(*)>  !  Could  use  truth 


1780  READ  #l;Bog(*>  !  same  comment  as  Bun.... not  used. 

1790  ! 

1800  READ  #1 ; 6batrue<*)  !  True  Euler  parameters  between  B  and  A  frame. 

1810  READ  #l;8bat rue<*>  !  same.... not  used. 

1820  IF  Pass*l  THEN  MAT  Bba=Bbatrue  !  Can  help  out  by  setting  est i mat e* t r ut h. 

1830  ' 

1840  PRINT  USING  F orm 1 ; " Bba. . . . True  Euler  parameters  between  B  and  A  frames:" 
, BbatrueC*) 

1850  PRINT  USING  F orm 1 Bba. ...  Current  Euler  parameters  between  B  and  F  frame 
s:  "  ,  BbaCO 
1860  ! 

1870  READ  #1;  ■/ocCO 

1880  PRINT  USING  Form3;  "Components  of  total  uelocity  <  k  m/sec  >:";  V'oc  <*  > 

1890  MAT  7oc«v'(.c<'<C> 

1990  ! 

1910  REDIM  Xy  na<  IE  1 , 3)  ,  Xymb<  1E1 , 3) 

1920  PRINT  USING  "K"; "Number  of  stars  in  each  FOV:  " 

1930  ! 

1940  READ  #1 ; -Ifoon a 

1950  PRINT  USING  "K,X,BD";"  FOV< A> : " , Nf ouma 
1960  READ  #l;><yma(*)  !  True  coordinates. 

1979  READ  #l;><yma<*)  !  Measured  coordinates. 

1980  ! 

1990  READ  #1 ;  'Ifoorrb 

2000  PRINT  USING  "K,X,BD";"  FOV< B ) : " , Nf oumb 
2010  READ  #  1 ; Kymbf* )  !  True. 

2020  READ  #l;<ymb<*>  !  Measured. 

2030  I 

2040  READ  §  1 ; 4 1 < * > , W2< * > , W3 < » >  I  Read  rate  gyro  data  for  eacn  axis. 

2050  ! 

2060  REDIM  Xk  t  <  7  > 

2070  READ  #1 ;  kk  t  (  ?  ) ,  Xk  t  <6  > ,  Xk  t  <  7 )  !  Read  true  bias  rates. 


2080  • 

2090  IF  Pc  =0  THEN  Sk  i  p3 

2100  CALL  Run jr (Tk,Delt,Step,Hl(*),U2(*),U3(*),Xki ( *) , Pk < * ) , Q< * ) , S i gb i as > 

2110  I 

2120  PRINT  USING  Form2; "Bun. . . . Integrated  Euler  parameters  between  V  ard  N  fr 
ames”  ,  “and  gvro  si  asesl  " ,  Xk  1  <*> 

2130  ! 

2140  REDII1  Xk  i  <  4  > 

2150  MAT  3vn=><k  i  !  Estimates  for  Process  B. 

2160  !  IF  Pas»s:l  THEN  MAT  Bvn=Bvntrue  !  Can  help  out  by  setting  est. “truth. 

2170  REDIM  Xk i <  7) 

2180  ! 

2190  Sk i p3: IF  Pc =d  TKEN  Tk=Tk+Delt 

2200  CALL  Orbit <Tk,Ps<*>,  Vs  <  O  ,  Ps0  <  O  , Vs0 < * > , T0 , Us , As , Ds0, Rs0> 

2210  CALL  Orbit < Tk , Pe< * > , Ve < * > , Pe0 < * > , Ve0 < * > , T0 , Ue , Ae , De0 , Re0 > 

2220  MAT  Voc  =  Vs+Ve  !  Total  velocity. 

2230  PRINT  USING  Form3; "Components  of  total  velocity  Ckm/sec > : ” ; Voc <*) 

2240  MAT  Voc=*7cc^<C) 

2250  ' 

2260  IF  Pb=0  THEN  Sk i p4 

2270  ' 

2280  MAT  .3bae=I:ba  !  Save  the  estimated  interlock  vector. 

2290  CALL  Pro:_b<#2,Bvn<*>,Bba<*),Voc<*>,  Nfovma,  Nf ovmb, Ka,  Kb ,  W,  S  i  gxy ,  Xj,  ma<  *  )  , 
Xymb<0,Xyca;*),-<ycb<*>,Cov8<*>,Pba<*>,Qba<*>,Bbalsq<*>> 

2300  !  OUTPUT  ft  USING  Form9; If i 1 e, Nfovma, Nfovmb, Ka, Kb  !  Progess  indicator. 

2310  Form9I  IMA jt:  5<DD,XX> 

2320  ! 

2330  FOR  1=1  TO  4 

2340  FOR  J=’l  TO  4 

2350  Co,><  I ,  J  >=Cov8<  I ,  J) 

2360  NEXT  * 

2370  NEXT  I 

2380  PRINT  # 1 ; Bun < * ) , Bba< * )  !  Save  Process  B  results. 

2390  PRINT  #l;Cov<*> 

2400  PRINT  #  1 ;  Ka,  ><  yc  a<  *  > 

2410  PRINT  # 1 ; Kb, Xycb<*> 

2420  ! 

2430  Sk ip4:  (F  P:-0  THEN  Endloop 

2440  ! 

2450  IF  Pb=0  THEN  READ  # 1 ;  Bvn< *>,  Bba< *), Cov <*>, Ka, Xyc a< *>, Kb , Xyc b< * > 

2460  IF  <Ka=0>  ANI  <Kb=0>  THEN  Proc_b_f ai 1 ure 

2470  REDIM  Xka<4> 

2480  MAT  Xkb=Bvn 

2490  REDIM  Xkj<7) 

2500  ! 

2510  FOR  1=1  TO  4 

2520  FOR  J=1  TO  4 

2530  Lsm<  I ,  »")*Cov<  I ,  J)  !  Fill  obs.  cov.  matrix  with  Proc  .  B  results. 

2540  NEXT  J 

2550  NEXT  I 

2560  ! 

2570  REDIM  Xk i <4> 

2580  MAT  T 1 « X  < i 

2590  REDIM  Xki<7) 

2600  ! 
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r 


i 

i 


CALL  Kal  nanO*  k  t  <  O  ,  Xk  i  < * >  ,  Pk < * > , Xk b< * > , Lam< * > > 

i 

!  Com#  here  if  Proc  B  failed  to  find  stars 


Proc_b_'ai  1  jr  e: 

! 

PRINT  il;Xki(*> 
PRINT 

! 

FOR  1=1  TO  4 
FOR  J=1  TO  4 
Short«’Pk  <  I ,  J> 
PRINT  #1; Short 
NEXT  J 
NEXT  I 

PRINT  #1 I'bal  sq<*> 


2610 
2620 
2630 
2640 
2650 
2660 
2670 
2680 
2690 
2700 
2710 
2720 
2730 
2740 
2750  ! 

2760  Endloop:  ! 
2770  PRINT  " 
2780  ! 

2790  NEXT  I'ile 
2800  ! 

2810  Stop: 

2820 

2830 

2840 

2850 

2860 

2870  ! 

2880  Form  1 :  IMfl^E 
2890  For  m2’.  IMR3E. 
2900  Form3:  .  IMFliE: 
2910  I 

2920  END 


in  botk  FOV. 


Saoe  Proc.  C  results. 


(end  of  frame)" 


PRINT 
PRINT  " 
FOR  1=1 
BEEP 
WRIT 
P EXT  I 


THE  END 


TO  5 
120 


/K,/,4<MD.DDDDDD,XX> 

'K ,/,K,r,4<MD.DDDDDD,X>,/,3(MD.DDDE,X) 
/-k,3</3<MD.DDDE,XX>) 


4 
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Access 

Access  determines  which  catalog  cells  the  camera  boresight  lies  in 
or  near  and  then  retrieves  the  star  positions  for  the  stars  contained 
in  those  cells.  The  first  step  is  to  determine  the  polar  angle  and 
longitude  angle  of  the  boresight  unit  vector.  These  angles  are  converted 
to  primary  cell  indices  by  dividing  by  the  cell  size.  In  a  similar 
manner,  we  also  determine  three  nearest  neighbor  cells.  The  location  of 
each  cell  in  memory  or  on  a  storage  device  and  the  number  of  stars  in 
each  cell  are  found  by  referring  to  a  table.  We  then  read  the  star  data 
from  these  cells  (consisting  of  direction  cosines  and  magnitude)  and 
compute  the  vector  dot  product  of  each  star  with  the  boresight  unit 
vector.  If  the  product  is  less  than  some  specified  tolerance  we  reject 
the  star;  this  product  is  also  used  to  sort  the  subcatalog  by  distance 
off  the  boresight.  A  list  of  up  to  100  stars  is  returned  to  the  calling 
program. 


See  Appendix  3  for  details  on  the  catalog  format. 
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************ ‘»***»4'«#4*#*ft»«*****#*#*****#**«****************** 
•  • 

*  ACCESS  * 

*  * 
************************************************************** 


6260 

6270 

6280 

6290 

6300 

6310 

6320 

6330 

6340 

6350 

6360 

6370 

6380 

6390 

6400 

6410 

6420 

6430 

6440 

6450 

6460 

6470 

6480 

6490 

6500 

6510 

6520 

6530 

6540 

6550 

6560 

6570 

6580 

6590 

6600 

6610 

6620 

6630 

6640 

6650 

6660 

6670 

6680 

6690 

6700 

6710 

6720 

6730 

6740 


!  Access  gets  stars  from  the  catalog  for  cells  surrounding  the  boresight 
SUB  Acoe  ss  <  1 ,  h  fov,  Bore  <*),  Si  gma,  Radi  us ,  Voc  <*),  SHORT  Food)) 

OPTION  BASE  1 
DIM  Ang< 103' ,Cc<3) 

INTEGER  K<4; , J<4) , Nt , Kk , M, N 
SHORT  Hag, Sum 

COM  Vg:3f 3), INTEGER  Table<529,2> 

REDIM  l-'ou<  180,4  > 

DISP  "Access" 


Nt=22  !  Nuirber  of  latitude  bands  for  this  catalog. 

Dphi =2*PI '<2*Nt + 1 >  !  Latitude  spacing. 

Nf ov=0 

Ct  est  =*COS  <  3iid  i  i.  s  +  S  i  gma)  !  Maximum  angle  off  the  boresight. 

Phi =AC3<Bo'< (3) )  !  Polar  angle. 

IF  Phi-:0  THEiN  Fhi=Phi  *2*PI 

j 

Lam=PI'2  !  Calculate  longitude  angle. 

IF  Bor.?<2)(0  TI-EN  Lam=Lam+PI 

IF  Bored)  <1-0  THEN  Lam=ATN<Bore<2)/'Bored  > ) 

IF  Bore <1X0  THEN  Lam=Lam+PI 
IF  Lam:0  THEiN  Lam*Lam+2*PI 

j 

PRINT  US  I N  j  "/,K,X,DDD.D,X,K"; "Polar  angle: ",  Phi  * 180xpi ,  " Degrees " 
PRINT  IJSIN3  MK,X,DDD.D,X,K"; "Longitude  angle: " , Lam* 1 80^P I , "Degrees" 


•  Calculate  cell  indices. 
IF  Phi \Dphi  THEN  North 
IF  Phi  >2*P  I  -Dpi-  i  *.  5  THEN  South 
! 

K < 1 >*2  1 1 NT< Phi x Dphi + . 5) 

K<3)*2 *INT<Phi /Dphi > 

IF  K<3)»K<i:  TEEN  K<3)=K<3)+2 
IF  K<  1  >  >Nt  THEP  Kd  )=2*Nt+l-K<  1  ) 
IF  K < 3  >  >Nt  THEh  K < 3 > =2*Nt  «■  1 -K < 3 > 
K<2)=K : 1 > 

K  <  4  )  *K  3  ) 


Near  north  po 1 e --spec i al  case. 
Near  south  po 1 e--spec i al  case. 

Calculate  two  neighboring 
latitude  bands. 


Make  sure  we're 
side  of  equator. 


the  correct 


D 1  am=2-tP I s <. 2*K d  )  ♦  1  >  1  Now  deter 

J< 1 )*INT<LamxDlam+,5)  !  in  each  1 

J<2>  * INT <  L amxD 1  am ) 

IF  J<2>  =  Jdi  TFEN  J<2)*<  J<  1  )  +  l  )  MOD  (2*K<1)M) 
Jd>«Jd>  10D  (2*K(1>M) 

Dlam«2tPIx<i:*K<3)-d> 

J<3>* INT<L  am^Dl am+. 5> 

J<4)*IHT  <L  am/Dl am) 

IF  J<4)*J<3:  TEEN  J<4>»< J<3)  +  1 )  MOD  <2»K<3>M> 


!  Now  determine  two  neighboring  cells 
!  in  each  latitude  band. 
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6750  J<3)«J:3) 

6760  GOTO  Arour 
6770 

6780  North: 

6790  K  <  1 )  *0 


10D  <2*K<3>+1 > 
d 


6790  K  < 1 ) *0 
6800  K<2>«2 

6810  K<3>*2 

6820  K<4>-2 

6830  J<1)*0 

6840  J<3)*INT<L 
6850  JC2)=J:3>+ 

6860  JC4)*J:3)+ 

6870  GOTO  Ai'oun 
6880  ! 
6890  South:  ! 
6900  K< 1 )*1 
6910  K  <  2  >  =  1 
6920  K<3)  =  1 

6930  K  <  4 ) *3 
6940  J<1>=0 

6950  J<2)*1 

6960  J<3)=2 

6970  JC4)=IHT<L 
6980  ! 

6990  Around:  !  S 
7000  PRINT  US  I N 
7010  ! 

7020  FOR  1=1  TO 
7030  M=K<f)»K 

7040  N=Table< 

7050  READ  #1, 

7060  Kk*Tab1e 

7070  FOR  I'*  1 

7080  READ  « 

7090  AOOTC 

7100  IF  ACC 

7110  Nf ow*N 

7120  AngCNf 

7130  ! 

7140  Sell** 

7150  MAT  Co 

7160  MAT  Co 


Special  case  for  north  pole. 


!  Get  Indices  for  polar  cap  and 
I  three  of  the  flue  cells  In  next  band. 


am/<2*PI/'5>  +  .  5> 
4  MOI  5 
1  MOI  5 
d 


Special  case  for  south  pole. 

!  Get  all  three  cells  at  south  pole  and 
!  one  of  the  seuen  In  the  next  band. 


am>'<2*PI/'7>*.5> 

<ip  rorth  and  south  pole  stuff. 

1  ,v,K,^,2<4<DDD,X)/>,‘;  "Cell  i  nd  I  ces :  "  ,  K<  *  > ,  J  C  *  ) 


< J  )+JCI)  +  l 

1,1) 

4 

<  M ,  2  > 

TO  Kk 

1 ;  Co<*> , Mag, Num 

2c,Bcre)  !  Compute  cos  of  interstar  angle, 

list  THEN  Continue 

fou+1  !  Star  lies  within  range  of  boresight, 

ou)*F 


1  -DOT  < Voc , Co) 

a(:o*<Scal*> 

«Co+Voc 


!  Add  aberration  effects. 


7180  FOR  J* 

7190  l-'ouC 

7200  NEXT  J 

7210  FouCNf 

7220  Continue:  N 
7230  Skip:  ! 

7240  NEXT  I 
7250  ! 

7260  IF  Nf ou<  >0 
boresight . 

7270  ! 

7280  DISP 
7290  SUBEND 


l  TO  3 

If ou, J) =Co< J)  !  Saue  this  star. 

du , 4>»Mag 

•>:t  k 


THEk  CALL  Sort CAngC* ) , FowC * > , Nf ou, 4)  !  Sort  stars  by  ancle  off 
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Bias 

Subroutine  Bias  computes  bias  terms  which  are  later  added  to  the 
rate  gyro  data.  We  have  used  a  simple  sinusoidal  variation  added  to 
each  nominal  bias  value.  For  input  we  specify  the  time,  orbital 
frequency,  nominal  bias  values,  and  amplitude  and  frequency  of  each 
variation. 
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«  Bins  * 
«  * 
•  •»«••»****«'****»*■**«  ***************************************** 


7650  SUB  Bi »s<Dt , SHCRT  Bi  asnom<*> ,  Ebi  as  <.*  > ,  Nbi  as  C  * ) ,  REAL  Omega,  Bi  as  (*>  > 
7660  !  This  subroutine  computes  the  bias  rates  to  be  added  to  gyro  rates. 

7670  OPTION  BPS;  1 
7680  • 

7690  Bi asC 1 )*B i a:  non  <l)+£bias<l>*COS<Hbias<l)*Omega»Dt) 

7700  Bi  as <2 >=Bi a «no» (2>+Ebias<2>*SIN<Nbias<2>*0mega*Dt> 

7710  Bi  as <3  >*Bi  ajnon  (3>«-Ebi  as ( 3) *S IN<Nb  i  as < 3 > *Umega*Dt  > 

7720  ! 

7730  SUBEND 
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Cross 

Subroutine  Cross  computes  the  vector  cross-product  of  two  vectors. 


j 


! 


I 


J 
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•ft****************-******************************************** 

«  * 

#  CROSS  * 

i  * 

##»*#♦*****#•♦»**»+*#«»#******####********#**»**♦************#* 

6290  !  This  suborogram  computes  the  cross  product  of  tuo  vectors. 

6306  ! 

6310  SUB  Cross<?<*>,Vl<*),V2<*>> 

6320  OPTION  BASE  1 
6330  I 

6340  FOR  K»l  TO  3 

6350  K1»K  NOD  3+1  !  Determine  the  order  of  multiplication. 

6360  K2-KI  NOD  3+1 

6370  R<K):*V1<<1  >*V2<K2>-V1  <K2)*V2<K1 ) 

6380  NEXT  K 
6390  ! 

6400  SUBEND 
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Deriv 

This  subroutine  forms  the  right-hand-side  of  the  matrix  Riccati 
equation,  which  is  integrated  by  subroutine  Runge  to  propagate  the 
covariance  matrix.  We  use  the  partitioned  form  of  the  Riccati  equation 
as  presented  in  Appendix  8  of  the  Final  Report. 

The  input  data  consist  of  the  upper  4x4  portion,  lower  left 
3x4  portion  and  lower  right  3x3  portion  of  the  covariance  matrix. 

In  addition,  the  subroutine  requires  the  3x3  process  noise  matrix 
and  two  portions  of  the  matrices  used  for  the  state  differential  equa¬ 
tions  (see  Appendix  8).  The  output  is  the  time  derivative  of  the  upper 
4x4  and  lower  left  3x4  portions  of  the  covariance  matrix  evaluated 
for  the  current  state. 


*****#****«#'*****+'#*«  *#*#*#***#«*###«**######**####»#»####**#* 

*  • 

*  D  E  R  I  V  * 

*  * 
**********#***•*»+'#*«•******#********•*«*****************•*#** 

14893  •  This  subroutine  sets  up  the  RHS  of  the  matrix  Riccati  equation  in 
14900  !  partitioned  form. 

14910  SUB  Deriv<»l 1 <« > , P21 <*> , P22< *) ,  Q< *> , A1 1 < *> , A12<* > , Kn<* )  ,  Ln<* > > 

14920  OPTION  BASE  1 

14930  DIM  T1 :4,4>,T2<4,4),A12t<3,4> 

14940  ! 

14950  MAT  Tl'*All*Ptl 
14960  MAT  T2*A12*P21 
14970  MAT  T1-T1+T2 
14980  MAT  T2:STRN<T  1 ) 

14990  MAT  Kn*Tl+T2 
15000  MAT  A12t*T?N<A12> 

15010  MAT  T 1 -A 12*0 
15020  MAT  T2*Tl*912t 
15030  MAT  Kn;sKn+r«: 

15040  • 

15050  MAT  T1»P21*A11 
15060  MAT  T2=P22»A12t 
15070  MAT  Ln*T2-Tl 
15080  ! 

15090  SUBEND 
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Dircosb 

This  subroutine  computes  the  rotation  matrix  between  two  coordinate 
frames  as  a  function  of  the  Euler  parameters.  If  selected,  the  partial 
derivatives  of  the  rotation  matrix  with  respect  to  each  Euler  parameters, 
are  calculated  also.  Refer  to  Section  2  of  the  Final  Report  for  the 
form  of  the  rotation  matrix. 
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********* *»****«»*-**« ««•***«****•»#*»*•****»#*»****•******»*#* 
t  * 

•  IIRCOSB  • 

*  * 
**************************************************************** 


8880 
8890 
8900 
8910 
8920 
8930 
8940 
8950 
8960 
8970 
8980 
8990 
9O00 
9010 
9020 
9030 
9040 
9050 
9060 
9070 
9080 
9090 
9100 
91 10 
9120 
9130 
9140 
9150 
9160 
9170 
9180 
9190 
9200 
9210 
9220 
9230 
9240 
9250 
9260 
9270 
9280 
9290 
9300 
9310 
9320 
9330 
9340 


•  Dircosb  computes  the  direction  cosine  matrix  using  EULER  parameters 
SUB  Dircoso<B<*>,C<*), Ndc , Dcl<*>,Dc2(*>,Dc3<*>,Dc4<*>) 

OPTION  BASE  1 
! 

DISP  Mircaib" 

I 


B0»B(1 > 

B1*B<2  > 

B2  =  B<3  > 

B3=B<4 > 

B12=>B1  *B1 
B22=B2*B 2 
B32=B3 »B3 
B02-B0fB0 

C<1,  1  >*B02*J:12-B22-B32 
C<1,2>==2*<B1*B2  +  B0*B3> 
C< 1 , 3>  -2*<  81 *B3-B0*B2) 
C<2,  1  >:s2*<  B1  *B2-B0*B3> 
C<2,2):-B02-B12-»  B22-B32 
C<2, 3>  =2*<B2*Bo+B0*Bl> 
C<3, 1) «2*<B1*B3+B0#B2> 
C<3, 2)  =2*<82*B:-B0*Bn 
C<3 , 3>:sB02-£12-  B22+B32 

i 

DISP 

t 

IF  Ndc:>l  THEN  SUBEXIT 
! 


DISP  ")irc  as  b” 

l 

B0=B0+30 

B1=B1+31 

B2-B2+32 

B3*B3+B3 

i 

Dc 1 ( 1 , D*B3 
Dci<l,2)«B3 
Dc 1 < 1 , 3>*-B2 
Dcl<2, 1>*-B3 
Dc  1  <2, 2)=»B3 
Dc 1 <  2 , 3 ) *Bl 
Dcl<3, 1  >*B2 
Dcl<3,;>)*-BI 
Dcl<3,3)-B3 
! 

Dc2<l, I )*B 1 
Dc2<l,;2>«B2 


Direction  cosine  matrix. 


!  Don't  need  partials. 

!  Compute  the  partials  of  C  w.r.t.  each  beta.. 
!  Do  this  for  factor  of  two. 

!  Partials  w.r.t.  Beta0. 

I  Partials  w.r.t.  Betal. 
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9350  Dc2<l,3)=B3 

9360  Dc2(2|  l  )*B2 

9370  Dc2<2,:2>»-61 

9380  Dc2<2,3>«BB 

9390  Dc2<3,t>*B3 

9400  Dc2<3,:2>»-B£» 

9410  Dc2<3,3>*-Bl 

9420  ! 

9430  Dc3<t,l)=-B2  !  Partial*  w.r.t.  Beta2. 

9440  Dc3<l,;2)*Bl 

9450  0c3<  1 1  3)®-B£i 

9460  Dc3<2,l)=Bl 

9470  Dc3(2,2)=B2 

9480  Dc3<2,3)*B3 

9490  Dc3(3,l)=B3 

9500  Dc3<3,:2)*B3 

9510  Dc3<3,3>*-8£: 

9520  ! 

9530  Dc4<l,t>*-83  !  Partials  y.r.t.  Beta3. 

9540  Dc4<  1 ,  i2)*B3 

9550  Dc4< 1 , 3)*B1 

9560  Dc4C2,  l)=-B£i 

9570  Dc4<2|  ;2)  =  -B3 

9580  Dc4<2,:3)=B2 

9590  Dc4(3,  l  >*B1 

9600  Dc4<3,;2>»B2 

9610  Dc4<3,3)=B3 

9620  » 

9630  DISP 
9640  SUBEND 
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Dxdbeta 


This  subroutine  computes  the  partial  derivatives  of  the  calculated 
image  coordinates  with  respect  to  each  of  the  four  Euler  parameters 
orienting  the  star  tracker.  We  have  rearranged  the  partial  derivative 
calculation  into  a  simple  form.  We  want,  for  FOV(A)  for  example. 


3X_ 


33 


VN 


•  I 


3X  3 AN  -  . 

m  _y_ 


t J  3ANij  36VN 


(m  =  1 ,2,. . .no.  of  stars 
n  =  0,1, 2, 3). 


We  note  that  matrix  3AN/33VN  =  AV  •  3VN/33VN  where  AV  is  calculated 

'n  Nn 

by  Mat-av  and  3VN/33VN  is  calculated  by  Dircosb  and  this  matrix  is 

n 

independent  of  the  particular  star. 

The  terms  3Xm/3AN^ j  are  derivatives  of  the  stellar  colinearity 
equations  with  respect  to  the  terms  in  the  rotation  matrix.  If  we 
rotate  a  star's  direction  cosines  {L}  into  the  FOV(A)  frame,  we  have 

{L1}  =  AN  •  (L) 


Then,  the  normalized  image  coordinate  X/f  =  Ll/U  where  f  =  lens  focal 
length.  The  3  *  3  matrix  3Xm/3AN  becomes 

Li  L?  L  3 

U  U  L3 

0  0  0 

kkl  kU  kkL 

I  ■  2  I  1  2  I  1  2 

_>-3  L3  L3  J 

or  simply  the  outer  product: 
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To  obtain  the  derivative  we  can  proceed  to  multiply  each  term  in  this 

3x3  matrix  by  the  corresponding  term  in  3AN/36yN  and  then  sum  all 

n 

terms.  However,  it  is  not  too  difficult  to  see  that  this  can  be 
accomplished  by  writing 


ax 


m 


36 


VN 


raAN  1 
Lie  J 


-36 


VN 


a  form  very  suitable  for  computation.  The  partial  derivatives  of  the  y 
coordinate  are  similar. 
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*************************************************************** 

*  * 

«  IXDBETfl  * 

*  * 

*****#*####*•♦****♦•*#«***##*##****#**#****»***##****#******#*** 

8350  I  Dxdbeta  zompttes  partial  derivs  of  (x,y)  w.r.t.  Euler  parameters. 
8360  !  d<x  or  y  > / ddet  a(  i  >  > *SumC  <d< x  or  y  >^(0 i  j  >  > .  <d(Ci  j  >/d(B*t a(  i  >  >  1 

8370  I  where  represents  mult,  correspondi ng  terms. 

8380  !  We  have  arr anged  thi s  sum  into  compact  form  used  here — (see 

8390  I  note:*  of  T.  Strikwerda). 

8400  SUB  Dxdbet *<  FI  c  (*>  ,  A(*>  ,  Kk  ,  C(*>  ,  Dc 1 <*> , Dc2(*> , Dc3(*> , Dc4(*> > 

8410  OPTION  BAS i  1 

8420  DIM  T1 ;3> , T3<3> , T4<3) , L<3> I  Dimension  temporary  matrices. 

8430  ! 

8440  DISP  ".3xdb»t  a" 

8450  ! 

8460  FOR  K=l  TO  Kk  !  Loop  over  all  stars  in  this  FOV. 

8470  K1=K*K-1 

8480  K2=K  l  ♦  1 

8490  FOR  l 1  T Ci  3  I  Get  direction  cosines  for  this  star. 

8500  l(  I  )»F  1  cl(K,  I  > 

8510  NEXT  I 

8520  MAT  T 1 *C *1.  I  Compute  direction  cosines  in  FOV  frame. 

8530  T3<1 >»l/ri<3) 

8540  T3( 2  >“0 

8550  T3<3>  —  Tl<  1 >* T3( 1 > *T3( 1 > 

8560  T4< 1  )»0 

8570  T4<2  >*T3( 1 ) 

8580  T4(3>*-T1<2)«T3(1)*T3(1> 

8590  ! 

8600  MAT  T 1 =D : 1 *L 

8610  A(K1  ,  1  )»0CiTOl ,  T3>  »  d( x > ^d ( Bet aO > 

8620  A  ( K2  , 1 ) »  DOT  < 1 1 , T4 )  !  d< y > 'd( Bet a0 > 

8630  ' 

8640  MAT  T 1  *D : «'*L 

8650  A(K1 ,2)»0CiT(Tl,T3>  !  d  <  x  >'d  (Bet  al  > 

8660  A(K2,2)*OOT(T1,T4>  !  etc. 

8670  ! 

8680  MAT  ri*D::!*L 

8690  A< K 1 , 3 ) * 0C»T ( 1 1 ,  T3 > 

8700  A(K2,3)«OOT(I 1,T4) 

8710  ' 

8720  MAT  T1«D:‘-*L 

8730  A(K1 ,4>»DCiT(U,T3> 

8740  A(K2,4>*OOT(T1,T4> 

8750  ! 

8760  NEXT  K 
8770  ! 

8780  DISP 
8790  SUBEND 
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Fill -y 

The  primary  purpose  of  this  subroutine  is  to  calculate  the  column 
vector  of  differences  between  the  calculated  and  measured  star  coordinates. 
As  input  we  pass  the  coordinate  frame  rotation  matrix,  and  an  array 
containing  the  direction  cosines  and  measured  coordinates  for  up  to  five 
paired  stars. 

Subroutine  Phoeqn  is  called  for  each  star  to  compute  the  image 
coordinates.  These  are  subtracted  from  the  measured  values  to  fill  the 
deviation  vector. 


*•**•*•*•***»**« »**#«**•*******•#*#*«*#****#*#*** **»»**•**»»** 

*  • 

*  F  1  L  L  -  V  * 

*  # 

•  ••ft**#*)***************#**************#******#**#******#****** 

7260  I  Fill  —  v*  F » 1 1 »  Dely<#>  with  deviation  b*tu«in  measured  and  calc. 

7270  I  star  posit iors. 

7280  SUB  Fill  y<Fld<#),Kk,C<*>,Dely<*>,  I  sum) 

7290  OPTION  BASE  I 
7300  DIM  XxC2>, :osires<3> 

7310  ! 

7320  DISP  "Filly' 

7330  ! 

7340  Idi  m*I:»um+<l<  *2 
7350  REDIM  )e1  y  <  1  di  ir  > 

7360  IF  Kk-U  THEN  SI  BEX  IT 
7370  I 

7380  FOR  K-  l  TO  Kk 
7390  FOR  l-l  TO  3 

7400  Co;»  i  ne»<  I  >-F1  d<K,  I  >  I  Get  direction  cosines  for  this  star. 

7410  NEXT  I 

7420  CALL  Pho?c|n<Cosi  nes<*  )  ,  C<  *  )  ,  Xx<  1  >  ,  Xx<2>  )  I  Compute  <x,y). 

7430  FOR  1-1  TO  2 

7440  Isurn-I sum+l 

7450  De I y< I »um>=Fl d<K, 3+1 >-Xx< I >  !  Compute  deviations  ♦ rom  measured  (x,y>. 

7460  NEXT  I 

7470  NEXT  K 
7480  ! 

7490  REDIM  3ely<lsu*> 

7500  » 

7510  DISP 
7520  SUBEND 


I 

I 

I 


Gauss 


Gauss  generates  and  adds  pseudo-Gaussion  noise  to  a  variable.  The 
method  is  to  add  together  12  random  numbers  between  0  and  1  and  subtract 
6.  This  yields  a  number  from  a  pseudo-Gaussion  distribution  with  a  mean 
of  0  and  a  standard  deviation  of  one.  Obviously,  this  distribution  will 
be  truncated  at  ±6  sigma.  This  number  is  then  scaled  by  the  standard 
deviation  and  added  to  the  mean  value  (both  required  as  input)  and  the 
result  returned  to  the  calling  program.  0 


j 
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*****«#««**»«»*»»*-**«**•*****# 
#  GAUSS 


* 

« 


##•*»»•»**** »***»***««•** *****•»«* **********»**•»»*»«****««««* 


6480  !  This  s-ibrottine  Adds  Gaussian  no is*  to  a  variable. 

6490  ! 

6500  SUB  Gauss <  3i g, fean,  Var  > 

6510  » 

6520  R-0 

6530  ! 

6540  FOR  I  * l  TO  12 
6550  R-R+RND 
6560  NEXT  1 
6570  » 

6580  Var*Si •j*<R-6)+l'*An  !  Scale  the  noise  by  sigma  and  add  to  mean. 

6590  < 

6600  SUBENB 
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Kalman 

Kalman  performs  the  Kalman  filter  calculations  outlined  in  Section 
4  of  the  Final  Report.  The  integrated  and  calculated  states  and 
corresponding  covariance  matrices  are  passed  to  Kalman.  Currently, 
we  also  provide  the  true  state  for  comparison.  The  integrated  state  is 
replaced  by  the  optimal  state  on  return  and  the  integrated  covariance 
matrix  is  replaced  by  the  updated  matrix. 


*»••***•••••***•  »*■*•«*«*»*•»***•*******•**#«*•#***•**•*•****** 


«  * 

«  KALMAN  * 

*  * 

eeeeeeeeae******  »*•*#«  •*»»»*«**«»**•***••  **•»**#***•«***• •****« 


12180 

12118 

12128 

12138 

12148 

12158 

12160 

12170 

12188 

12190 

12208 

12210 

12220 

12230 

12248 

12250 

12268 

12278 

12288 

12298 

12388 

12318 

12320 

12330 

12340 

12358 

12360 

12370 

12380 

12390 

12400 

12410 

12420 

12430 

12448 

12450 

12460 

12470 

12480 

12490 

12500 

12510 

12520 

12530 

12540 

12550 

12560 


I  Ktlnin  computes  th«  optimal  state  estimate  at  each  time. 
I 

I  T.  S-;r1k-»«r<U . 28  May  1981. 

! 

SUB  Kalman<Xkt<*>,Xki <*> , Pk <#> , Xkb<*> , Lam<*> > 

OPTION  BAS  £  1 
DIM  Xk :7), :crr<7) 

DIM  SI C7,7),S2<7,7) 

DIM  Kal(7, ?: ,Dev<7> 

! 

DISP  "Kalmar." 

Ul-16 

U2-0 

! 

PRINT  USIN5  "/k"; "  Kalman  Filter  State  Estimation" 

! 

MAT  Sl:*TRN<Pk  )  ! 

MAT  Pk^SI  +  H  !  Ensure  symmetric  Pk . 

MAT  Pk=*<.5>«Pk  i 


FOR  I«!J  TO  7 
Xkb< t>»X<i <I> 


NEXT  I 

1 

MAT 

Sl'» 

| 

Lam+F'k  ! 

MAT 

S2* 

TRN<Sl ) 

MAT 

SI’* 

S 1  +  52 

MAT 

Sl'« 

1 

<.5>*S1 

MAT 

S2:* 

I 

INV(Sl) 

MAT 

! 

si* 

TRN<$2> 

MAT 

S2!* 

SI  ♦52 

MAT 

S2* 

| 

< . 5)*S2 

MAT 

Kal 

| 

«Pk  *S2 

MAT 

Dev 

I 

■Xko-Xki  ! 

MAT 

! 

Cor 

r»Kel  *D« v ! 

MAT 

Xk« 

XkUCorr  ! 

MAT 

SI’* 

Kal *Pk  1 

MAT 

Pk>* 

| 

Pk-51 

MAT 

SI  * 

TRN<Pk  > 

MAT 

Pk'* 

Pk  +  51 

I  Fill  measurement  vector  with  bias  values. 

Add  obs.  cov.  matrix  to  integrated  cov.  matrix. 


j 

!  Ensure  symmetric  matrix. 
! 


! 

!  Ensure  symmetric  matrix. 

( 

!  Compute  Kalman  gain  matrix. 

Deviations  between  st at es--<Obser . - i nteg.  state). 

Correction  vector. 

Calc,  optimal  state. 

Calc,  updated  covariance  matrix. 


! 

I  Ensure  symmetric  matrix. 
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12570  MAT  Pk'*< .  5>*Pk  ! 

12580  ! 

12590  PRINT  IJSIN:  State  Vectors _ 

Pi  fftrtncti _ M 

12600  PRINT  IJSIN3  mKm;“  True  Integ.  Proc .  B  Opt.  Est .  <I-7> 

<B-T)  CO-T)1 

12610  ! 

12620  FOR  I»l  TO  7 

12630  PRINT  USING  Form2; Xk t <1 > , Xk i < I > , Xkb< I > , Xk < I > , Xk i < I >-Xk t < I ) ,  XkbC I > - Xk t <  I  > 
,  Xk  <  I >-Xkt  <  I  ) 

12640  NEXT  I 
12650  ! 

12660  REDIM  Xk<4> 

12670  Norm«SiiR<D3T<Xk,Xk>> 

12680  PRINT  IJSINj  Forml;"Norm  of  optimal  estimate  -  l:", Norm-1 
12690  MAT  Xki*Xk/<Norir )  1  Normalize  the  optimal  estimate. 

12700  REDIM  Xk  <7> 

12710  ! 

12720  MAT  Xki*Xk  !  Set  state  ■  optimal  state... This  is  the  starting 

12730  I  estimate  for  the  next  frame. 

12740  ! 

12750  Forml: (MAGE  /K> , MD. DDDDDDDD/ 

12760  Form2! IMAGE  7<MD. DDDE, X) 

12770  Form3: (MAGE  7 C P D . DDDE, X)/ 

12780  ! 

12790  DISP 
12800  SUBEND 
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Least 

Least  solves  the  least-squares  problem  for  differential  corrections 
to  the  Euler  parameters.  Formally,  the  solution  is: 

AB  =  (ATWA)_1  AT  WAX 

where  W  is  a  weight  matrix,  A  is  a  matrix  containing  partial  derivatives 
of  image  coordinates  with  respect  to  Euler  parameters,  and  AX  is  a 
vector  of  differences  between  measured  and  calculated  coordinates. 
However,  we  have  adopted  a  diagonal  weight  matrix  and  thus  absorb  the 
weights  into  A  and  AX  (in  the  calling  program).  Therefore,  we  write 

AB  =  (ATA)_1  AT  AX, 

the  form  used  in  this  subroutine. 

T 

The  covariance-like  result  (A  A)"1  is  returned  to  the  calling 
program  along  with  the  corrections,  AB. 
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************ 

* 

* 

************ 

7610  !  This  routine  computes  < <flCtranspos*3  *  fi>Cinversel>  *  flttranspose!  *  Dy 

7620  !  where  Dy  is  the  vector  of  deviations. 

7630  SUB  Le  1st  0<  *>  ,  Dx<  *>  ,  Cov<*>  ,  Dy  <*  > ,  Idi  m,  Jdi  m> 

7640  OPTION  BflS £  1 

7650  DIM  T1 CJdi », Jdi m> , T2< Jdi m> , fit < Jdi m, Idim) 

7660  ! 

7670  DISP  "Least' 

7680  < 

7690  MfiT  flt!,TRN<fl> 

7700  MAT  Tl;lflt*^ 

7710  MfiT  Cov*INi/<Tl>  !  Cov  ■  (fiC transpose!  *  A  Hinverse!. 

7720  MfiT  T2:*flt*Dy 

7730  MfiT  Dx:*Cov*T2 

7740  ! 

7750  DISP 

7760  SUBEND 


********************** ***************************** 

* 

LEAST  * 

* 

************************************************** 
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Least-1 

This  subroutine  performs  an  Iterative  least-squares  correction 
using  coordinate  data  from  one  field  of  view.  The  current  values  of 
8vn  are  passed  to  Least-1 ,  along  with  the  rotation  matrix  AV  or  BV  and 
the  matrix  containing  direction  cosines  and  measured  image  coordinates  for 
paired  stars  for  that  field  of  view.  The  corrected  Euler  parameters  are 
returned  along  with  the  covariance  matrix  result  from  the  least-squares 
correction. 

The  method  employed  is  to  first  call  Dircosb  to  compute  the 
rotation  matrix  VN  and  its  partial  derivatives.  Fill-y  then  computes 
the  differences  between  measured  and  calculated  image  coordinates. 

Pre-mult  converts  partial  derivatives  of  VN  to  derivatives  of  AN  or  BN  by 
multiplying  by  AV  or  BV,  respectively.  Dxdbeta  uses  these  partials  to 
compute  the  partials  of  image  coordinates  with  respect  to  Euler  parameters, 
6vn.  The  last  row  of  the  derivative  matrix  is  filled  with  the  constraint 
equation. 

Finally,  subroutine  Least  is  called  to  compute  corrections  to  8VN. 

If  these  are  small  enough  we  return  to  the  calling  program.  Otherwise, 
we  Iterate  again,  up  to  a  limit  of  six  times. 


I 
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****************  *4-***  ***************************************** 

*  * 

*  L  E  A  S  T  -  1  * 

*  * 

****************  *****  ***************************************** 

11480  SUB  Le sst_l < Bvr <*>, Av<*> , F 1 d<* >, Kmax, W, Cov<* >, Converge ) 

11490  OPTION  BPS i  1 

11500  DIM  Saveb<  *'  ,  Bs  <4>  ,  Dvnl  < 3, 3>  ,  Dvn2<3, 3) ,  Dvn3<3,  3)  ,  Dvn4<3, 3>  ,  An<  3 , 3 ) ,  Vn< 3 , 3 > 
11510  DIM  Delx<4),Dely<ll),A<ll,4) 

11520  ! 

11530  MRT  Sa'/>*b=Bvn  I  Saw*  th*  original  utluts  of  Euler  parameters. 

11540  ! 

11550  PRINT  US  IN!  VK";"  Least -Squares  Correction  For  One  FOV" 

11560  FOR  It=l  T 3  6 

11570  CALL  Dir:osb<Bvn<*), Vn<*>, 1 , Dvnl <*> , Dvn2<*> , Dvn3<*> , Dvn4<*> > 

11580  MAT  An=R  j*Vn 

11590  lsum=0 

11600  REDIM  De  1  y  <Knr  ax*2 ) 

11610  CALL  Fill  y<Fld<*>,Kmax,An<*>,Dely<*>, Isum> 

11620  Sql=3QR<OOT<Iely,Dely>/<Kmax*2>> 

11630  PRINT  USING  K, D. DDDDE" ; "RMS  error  for  normalized  image  coordinates:", 
Sql 

11640  ! 

11650  REDIM  A<<n.ax*2+l,4),Dely<2*Kmax+l> 

11660  CALL  Pre  n.ul  t  <Av<*>  ,  Dunl  <*> ,  Dvn2<*>  ,  Dvn3<*> ,  Dvn4<*> > 

11670  CALL  Dxd  D«t  a<F 1 d<  *  > , A<*  > , Kmax, An<*> , Dun  1 (*> ,  Dvn2  <*>,Dvn3<*),Dvn4<0) 
11680  ! 

11690  FOR  1=1  TO  4 

11700  A<;2*Kma>:+l ,  I  >«2*M*Byn<  I  >  !  Constraint  equation. 

11710  NEXT  I 
11728  ! 

11730  Dely :2*Knax+l )=W*< 1 -DOT < Bun, Bun) > 

11740  ! 

11750  CALL  Least < A< * > , De 1 x < * ) , Cov< * > , De 1 y < * > , Kmax*2+ 1 , 4 > 

11760  ! 

11770  MAT  3s=B  jti 

11780  PRINT  USING  "/',KM;H  Beta<old>  Beta(new)  De  1 1  a<  Bet a) " 

11790  FOR  1=1  TO  4 

11800  Bun< I  >  *Isvn<  I  >+Del  x<  I  ) 

11810  PRINT  JSINC  "X3(MD.DDDDDDD,XXXX)",‘Bs<I> ,  Bun<  I  >  ,  De  1  x<  I  ) 

11820  NEXT  I 

11830  Dev=3QR<OOT(Ielx,Delx>/4) 

11840  PRINT  USING  K, D. DDDDE" ; "RMS  change  in  Euler  parameters:  ",Deu 
11850  ! 

11860  IF  D'»w<  1  i- 6  THEN  Morestars  !  Small  c  orrec  t  i  ons .  .  .  ex  i  t  loop. 

11870  NEXT  I- 
11880  ! 

11890  Nosol n :  PRINT  "******  LEAST-SQUARES  FOR  ONE  FOV  DID  NOT  CONVERGE  *♦«***" 
11900  Conu<»rge*0  !  Failure  of  least-squares. 

11910  MAT  3wn=3awet  !  Replace  Euler  parameters  with  original  values. 

11920  MAT  Cov-ZER 

11930  PRINT  USING  Forml ; "Number  of  i terat i ons: ”,  1 1  —  1 , Converge 
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11940  SUBEXIT 
11930  I 

11960  Morest »rs:  Converge*! 

11970  MAT  Cov*^c<v*<Sql*Sql  >  I  Compute  cow.  mat r  i  x.  .  .  rnul  t .  by  sigma** 
11980  PRINT  USING  Forml ; "Number  of  i terat i ons: ",  1 1 , Converge 
11990  Forml:  IMfl^E  K, X, DD, XXX, "Converge*" , D 
12000  • 

12010  SUBEND 
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Least-2 

Least-2  updates  the  Euler  parameters  and  via  least-squares 
differential  correction,  using  between  3  and  5  matched  stars  from  each 
FOV.  Both  and  3BA  should  initially  be  very  near  their  final 
corrected  values  (3^  has  been  corrected  by  Pair-It  and  3B^  does  not 
vary  rapidly);  thus  the  least-squares  requires  only  2  or  3  iterations 
to  converge.  Since  this  also  means  the  derivatives  do  not  vary  substan¬ 
tially  between  iterations,  we  can  use  the  secant  method  (subroutine 
Secant)  to  update  the  matrix  of  partial  derivatives  used  in  the 
least-squares. 

As  input  we  pass  the  current  values  of  3VN  and  and  the  arrays 
containing  the  direction  cosines  and  measured  coordinates  for  up  to  5 
stars  per  FOV.  We  return  the  updated  Euler  parameters  BVN  and  BBA  and 
the  4  x  4  covariance  matrix  associated  with  bvn-  For  each  least-squares 
iteration  we  compute  the  differences  between  measured  and  calculated 
images  for  corresponding  stars  and  the  change  in  these  differences 
compared  with  the  previous  iteration  (to  be  used  by  Secant) .  On  the 
first  iteration  we  calculate  the  exact  derivatives  of  image  coordinates 
with  respect  to  both  B^  and  BBA  (via  calls  to  Dircosb,  Mat-av, 

Pre-mult,  Post-mult  and  Dxdbeta  -  see  Appendix  7).  The  last  several 
rows  of  the  derivative  matrix  are  filled  with  the  constraint  equations, 
one  for  each  set  of  Euler  parameters  (multiplied  by  an  appropriate 
weight)  3BA,  see  Section  3  and  Appendix  7).  A  call  to  Least  returns 
corrections  to  all  eight  Euler  parameters;  if  these  are  small  we  return, 
otherwise  we  iterate  again,  using  Secant  to  update  derivatives. 
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**#**•******'**»*»***«*«***»******«*****************#•*****•** 

•  * 

*  LEAST-2  # 

*  * 
#•**»#•#•***+*•*»*'*««**#****#«*»»**•###******#**••*********** 

15180  SUB  Least_2cBvr  <* >  ,  Bba<* > , Ka,  F 1 da< * > , Kb, F 1 db<* > , W, Cov8< * > > 

15190  OPTION  BASE  1 

15200  DIM  A<:26,8>,De1 y<26> , Ddy<26> , At l<10,4>,At2< 10, 4) , Del x<8> , Bbasave<4> 

15210  DIM  An C3, 3), Bn (3, 3) 

15220  DIM  Av:3,3>,DavK3,3>,Dav2<3,3>,Bav3<3,3>,  Dav4<3,3> 

15230  DIM  Ba:3,3),Dbs.l<3, 3 >  ,  Dba2<3, 3 > , Dba3 < 3 , 3 > , Dba4< 3, 3> 

15240  DIM  Vn  .3, 3) , Dvr  1(3,3), Dvn2(3? 3> , Dvn3<  3, 3) , Dvn4  <3, 3> 

15250  ! 

15260  PRINT  USING  "✓,K,‘;"  Least  -Squares  Correction  For  Two  FOV" 

15270  PRINT  USING  " / , K , D,  K , D,  K“  ;  "Corrtc t  orientation  using  ",Ka,"  stars  from  FOV 
(A)  and  " ,Kb,M  stars  from  FOV<B>." 

15280  Sqts=lE40 
15290  Ka2*Ka+Ka 

15300  Kb2**Kb>Kb  !  Set  up  some  constants  and  dimensions. 

15310  Kk “Ka2*Kb2 

15320  Ipass2-1 

15330  Jdi m=8 

15340  Id i  m*K  »2  +  K d2+2-*  4 

15350  ! 

15360  REDIM  rt< I d i m, Jc i m> , Ddy < Idi m) 

15370  MAT  De  I  y»ZIR 
15380  MAT  Aa.JER 

15390  MAT  Cov8*2iP  !  Initialize  some  matrices. 

15400  MAT  Bbasav?~Bba  !  Saue  Euler  parameters  in  case  of  failure. 

15410  ! 

15420  ! 

15430  FOR  It=l  TO  4 
15440  Exact:  ! 

15450  I»um*3 

1 5460  CALL  Di  rccsb<Bon<*> ,  Vn<*> ,  Ipass2,  Dvnl  <  *> ,  Dvn2<  *> ,  Dvn3<*>  ,  Dvn4<* )  > 

15470  CALL  Oirccsb<Bba<*),Ba<*>, I pass2 , Dbal < * > , Dba2< * > , Bba3 ( * >  ,  Dba4 < * ) > 

15480  CALL  '1at_s.v<Ba<*),Dbal<*>,Dba2<*>,  Dba3< «> , Dba4 <* > , Av<* ) ,  Ipass2, Davl (* 

),  Dav2<»>,  Dau3<*> ,  Dav4<*>  > 

15490  MAT  A'»«=Au*Vn 

15500  MAT  B-*=Ba«An 

15510  REDIN  Dcy (Kk ) , De 1 y<Kk  ) 

15520  MAT  Ddy*Dely 

15530  CALL  ri 1 l_y <F1 da< * ) , Ka, An(* > , De 1 y< * > , I  sum)  !  Deviations  for  F0V<R). 

15540  CALL  r i 1 1  y <F 1 db< * ) , Kb, Bn< * ) , De 1 y ( * > , I  sum >  !  Deviations  for  FOV(B>. 

15550  MAT  Ddy*Dcy-Dely 

15560  Sqt*S3P(DCT(Dely,Dely)/Kk  > 

15570  PRINT  USISG  K, X, D. DDDDE" ; "RMS  error  in  normalized  image  coordinate 

s:  " ; Sqt 

15580  IF  Sqt<Sqts  THEN  Decreasing 

15590  Ipasi2*l  !  Flag  to  compute  exact  derivs.  because  the 

15600  Sqts*lE40  I  image  error  is  increasing. 

15610  GOT D  Exact 


15620 

15630 

15640 

15650 

15660 

15670 

15680 

15690 

15700 

15710 

15720 

15730 

15740 

15750 

15760 

15770 

15780 

15790 

15800 

15810 

15820 

15830 

15840 

15850 

15860 

15870 

15880 

15890 

15900 

15910 

15920 

15930 

15940 

15950 

15960 

15970 

15980 

15990 

16000 

16010 

16020 

16030 

16040 

16050 

16060 

16070 

16080 

16090 

16100 

16110 

16120 

16130 

16140 

16150 

16160 


H7 


! 

Decreasing:  !  Com*  her*  is  solution  is  converging. 

Sqts«3qt 
REDIM  UdyCIdim) 

Ilr  Ipsss2*2  THEN  Sec ant_m*t hod 
I  pass  2*  2  ( 

!  Coirput#  partial  derivs.  of  <x,y>  for  FOV<fl>. 

CRLL  3reju1  t<Rv<*>,Dvnl<*>,  Dvn2<*  >  ,Dvn3<*>,Dvn4<*>> 

CRLL  *ost_mul  t  < Vn(*> ,  Davl  <  *> ,  Dav2<  *> ,  Dav3<*> ,  Dav4(*>  > 

CRLL  0>:db«  ta<F1da<*>,  fit  1  (  *  ) ,  Ka,  fin  ( * ) ,  Dvnl  (*>  ,  Dvn2<*> ,  Dvn3<*> ,  D1,  r>4  <*  >  > 
CRLL  0>:db«ta<F  1  da(*),flt2<*),  Ka,  Rn<*> ,  Davl  (*> ,  Dav2<*> ,  Dav3(*> ,  Dc.v4<*> > 

I 

FOR  1*1  TC  4 
FOR  t>>  1  TO  Ka2 

fi<K, I >=flt 1 <K, I >  !  Fill  fl<#>  with  FOV<fl>  derivatives. 

RCK,  H4>*flt2<K,  I) 

NEXT  K 
NEXT  I 

j 

!  Compute  partial  derivs.  of  <x,y>  for  FOV<B>. 

CRLL  5r»_  rrul  t<Ba<*>,Dvnl<0,  Dvn2(  *  >,Dvn3(*),Dvn4<*>> 

CRLL  3c.st_n.ult<fin<*>,Dbal<*>,Dba2<0,Dba3<*>,Bba4<*>> 

CRLL  5rej u 1 1  <  Ba<  *) , Davl < *) , Dav2( #> , Dav3 ( * ) , Dav4< *> ) 

MRT  D Dal =1 bal +Dav 1 
MRT  D  D<i23t ba2+Dav2 
MRT  DDii3*Iba3+Dav3 
MRT  Doa4=Iba4+Dav4 

CRLL  D>:dbet  a<Fl  db<*) ,  fit  1  <  *  )  ,  Kb,  Bn  <  * ) ,  Dvnl  <*> ,  Dvn2(*> ,  Dvn3<  *  ,  D'.  n4'*i) 
CRLL  0>:dbe  ta<F1db<*),fit2<*),  Kb,  Bn  <*>,Dbal<*),Dba2(*>,Dba3<*),Bta4 

I 


FOR  1=1  TC  4 
FOR  K* 1  TO  Kb2 

R<Ka2+K,  I  >*>flt  1  <K,  I  >  !  Fill  R(*>  with  FOV(B)  derivatives. 

fi<Ka2-»K,  I+4>*flt2<K,  I  ) 

NEXT  K 
NEXT  I 

i 


GOTO  _sq 
Secant  met  Dc>d:  ! 

CRLL  5«cart<A<*>,Delx<*>,Ddy<*>, I d i m , Jd i m ) 
Lsq:  f 

REDIM  I'elyCIdim) 


FOR  1*1  TC  4 

R<K<h 1, I)-Bvn<I>*W*2  ! 

R<K<+1,4+I)»0 

fl<K<-»2,4  +  I>*Bba(I>*W*2  ! 

fl < K < -t-2 ,  I  >*0 
NEXT  I 
I 

D.»ly<  <M-l >«W*< l-D0T<Bvn, Bvn)  > 
D.*1y<  <1.  ♦2>*W*<l-D0T<Bba,  Bba)  > 
MRT  DdyaD«1y 

i 


Constraint  eq.  for 
Constraint  eq.  for 

I  More  constraint 

I  II  II 


Bvn. 

Bba. 


eq. 

II 


CRLL  _  «'ast<A<*),D*  !*<*), Cov8<*),Dely(*>,  Idim,Jdim) 


148 


16170  » 

16160  PI?  1 H  T  USING  K/K“ ;  "  Euler  parameters  and  correction!:"," 

<V-N>  delta-B(,/-N>  B<B-fl>  dtltt-KB-f))" 

16190  I 

16200  FOR  1-1  TC  4 

16210  Bvn< 1 >“Ivn(I>+De1x<I> 

16220  Bba<l >«Iba< I >+Del x(4+I > 

16230  PRUT  USING  "4<HD.  DDDDDDD,  XX>  “ ;  Bvn<  I  > }  De  1  x<  I  ) ,  Bba<  1  > ;  Be  1  x(4+I  ) 

16240  NEXT  I 

162S0  I 

16260  D'?v*S3P<DC T(De l  x,  Del  x)/8) 

16270  PRINT  USING  K, X, D. DDDDE" ; "RMS  change  in  Euler  parameters: Dev 

16280  IF  De .»< IE- 7  THEN  Covariance 

16290  NEXT  It 

16300  GOTO  Two  failed 

16310  ! 

16320  Covariance:  ! 

16330  PRINT  “  (End  of  1  east -squares  for  two  FOV)" 

16340  MRT  Cov8*Cov€*(Sqt a2)  !Mul  t . <RCtranspose3*fi> < i nverse)  by  sigmaA2. 
16350  !  PRINT  USING  "8<MD. DDE, X) ✓" ; Cov8 < * ) 

16360  SUBEXIT 

16370  Tuo_fai led:  ! 

16380  PRINT  LERST-2  FRILED  <-<-<-<-<-<-<-■• 

16390  ! 

16400  SUBEND 
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Mata 

This  subroutine  computes  part  of  the  right  hand  side  of  kinematic 
differential  equations  governing  Euler  parameters.  For  input  data  Mata 
requires  the  current  Euler  parameters,  3VN,  the  rate  gyro  data  and  the 
rotation  matrix  VG  to  rotate  the  gyro  rates  from  the  gyro  to  vehicle 
frame.  We  can  express  the  differential  equations  as 

(3)  =  [u>]6 
=  [B]u> 

(see  Section  4  and  Appendix  8  of  the  Final  Report  for  details);  Mata 
fills  matrices  [00]  and  [e].  These  two  forms  are  also  needed  for 
integrating  the  matrix  Riccati  equation  for  covariance  propagation. 
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#  MATA 

* 

********«*««-*«*•  »+*#«  ##***«*•«*#*******  ###*#*#♦******#*#*#*** 


12890  SUB  Ma;aCF,HC*>,XC*>,AllC#>,A12C*>> 

12900  OPTION  BASE  1 
12910  CON  VgC3,3> 

12920  BIN  Al;>pC4,:D,l«vC3> 

12930  I 

12940  MAT  Mv«Vg«4 
12950  MAT  Wv«Wv*C.5> 

12960  Wl*l4vC  t  > 

12970  I42»WvC;>> 

12980  I43»WvC3> 

12990  ! 

13000  !  Calc. 

13010  ! 

13020  ! 

13030  A11U,  l>=0 
13040  AUU,;>>  —  41 
13050  All(l,:})*-4;: 

13060  A1 1  <  1 , 4>*-42l 
13070  ! 

13080  A1 1  <2,  l  >  =»W  1 
13090  All<2,2)«0 
13100  A1 1  <2, 3 >*14 3 
13110  A1 1 <2, 4  >*- 42 
13120  ! 

13130  All(3, t  >*U2 
13140  All  <3,  :2>*-4ii 
13150  AU<3,3>-0 
13160  A11C3,4>*I41 
13170  I 

13180  A1 1 <4, l  >*W3 
13190  A11<4,;>)*I42 
13200  AU<4,3>»- 41 
13210  All<4,4>-0 
13220  < 

13230  IF  F«0  THE 4  SUiEXIT 
13240  ! 

13250  !  Calc,  matrix  A12  »  -DC  CB0,  B1 ,  B2,  B3>D0T)/'D<N1 ,  W2,  W3> 

13260  «  -  DC  <  B0,  B1 ,  B2,  B3>D0T>-/DCbl ,  b2,  b3> 

13270  ! 

13280  B0-XC1 >*.5 
13290  B 1 *XC 2  > * . 5 
13300  B2*XC3  )■*.  5 
13310  B3»XC4  >*.5 
13320  ! 

13330  A12p< 1 ■ 1  >*B1 
13340  Al2p<l ,2>»B2 
13350  A 1 2p < 1 , 3  > ■ 83 


I  Rotate  gyro  rates  into  V  frame, 
t  Divide  by  2  now  instead  of  later. 


matrix  A1 1*DC CB0, B1 , B2, B3>DOT>/DCB0, B1 , B2, B3> 

where  B0,B1,B2,B3  are  Euler  parameters. 


151 


! 

I 

I 

I 

I 

I 


13360  t 

13370  A12p<2 . 1  )■  -1>0 
13380  A12p<2,2>»83 
13390  A12p<2  •  3>s-l>2 
13400  ! 

13410  R12p<3, 1  >*-l<3 
13420  A12p<3,2>--»0 
13430  A12p<3.3>-81 
13440  ! 

13450  A12p<4, 1)»B£ 

13460  A12p<4 ,  2 >■  -IU 
13470  A12p<4,3)--li0 
13480  ! 

13490  MAT  A12«A12p*Vc  !  Multiply  by  rotation  matr 

13500  I 

13510  SUBEND 


I 


] 


1 

1 
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Mat-av 

This  subroutine  calculates  the  rotation  matrix,  AV,  between  the 
vehicle  and  star  tracker  (A)  frame.  The  matrix,  BA,  between  star 
tracker  frames  is  required  for  input.  If  selected,  the  partial  deriva¬ 
tives  of  AV  with  respect  to  elements  of  BA  are  calculated.  (See 
Appendix  7  for  details). 
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**»*•*•***•*'**##»*'**«  *********************  «»*«*#**•****»##*•»* 
*  * 

*  f  fl  T  _  fl  V  * 

»  * 

*■*■***■*#***■**•♦**•*  *♦•**«  ********************  i  ****«****•***•##**•# 


19220  SUB  Ma;  av<Isa< *  ) ,  Dba0<* > ,  Dbal  < * >  ,  Dba2<«  > ,  Dba3<* ) ,  Av<# ) ,  Der ,  Dav0< * > ,  I avl  < * > 
,Dav2<*>#Dav3“*>> 

10230  OPTION  BRS;  1 

10240  DIM  T1  C3,3),T2<3,3>,T3<3,3>,T4<3,3> 

10250  ! 

10260  DISP  "Mat  »vH 
10270  ! 

10280  D1»1/Si3R<2  4-2*B2.<3,3>>  !  Two  useful  factors. 

10290  D2*1/SQR<2-2*B*<3,3>> 

10300  ! 

10310  Av< 1 , 1 >»Ba<3, 1 )»D1  !  Compute  matrix  flV  from  Bfl. 

10320  Av<2, 1 >=Ba<3,2>*Dl 
10330  flu <3, 1 ) ■ . 5 / D 1 
10340  i 

10350  Av<l,2>*Ba<3, 1>*D2 
10360  Ru<2,2>>Ba<3,2)*D2 
10370  Av<3, 2  >*-. 3/D2 
10380  ! 

10390  Rv<l,3)a-2*I:a<2,2)*Dl*D2 
10400  Av<2,3>=2*Ba<3, 1>*D1*D2 
10410  Av(3, 3  >»0 
10420  ! 

10430  DISP 
10440  ! 

10450  IF  DerOl  THEN  SUBEXIT 
10460  ! 

10470  DISP  "Mat  av" 

10480  ! 

10490  MAT  T 1  ;sZER 
10500  T1<1, 1 >*D1 
10510  Tl < 1 , 2  >*D2 
10520  T1 <2, 3  >*2»D1 »D2 
10530  ! 

10540  MAT  T2:*2ER 
10550  T2<2,1>-T1<1,1> 

10560  T2<2, 2 >*T1 (1,2) 

10570  T2< 1 , 3  >*-T 1 <  2, 5 ) 

10580  ! 

10590  T3<1,  1  >—  1,  1>*D1*D1 

10600  T3<2,  1  >—  Av<2,  1)#D1*D1 
10610  T3<3, 1 >-.5*IU 
10620  T3< 1 , 2  >*flv<  J , 2>*D2*D2 
10630  T3<2l2>«Rv(2f 2>*D2»D2 
10640  T3<3, 2  >“D2». 5 
10650  T «Be<  3 ■ 3  >  #  3«  <  D 1 #D2  >  A3 
10660  T3<1,3>  — Ba<3,S>*T 
18670  T3<2,3>-Ba<3, 1>«T 

1 


I  Leave  SUB  if  we  don't  need  partials. 


!  Compute  d<RV<*>  >^<88(3,  1  >  > . 


!  Compute  d<RV<*>>/'d<Bfl<3,2>>. 


!  Compute  d<RV<*>)/'d<BR<3,3>>. 
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10680 

10680 

10700 

10710 

10720 

10730 

10740 

10750 

10760 

10770 

10780 

10790 

10800 

10810 

10820 

10830 

10840 

10850 

10860 

10870 

10880 

10890 

10900 

10910 

10920 

10930 

10940 

10950 


T3<3,3>"0 

i 

HAT  DauO-Tl* <Dta0<3, 1>> 
MAT  T4‘«T2*<I'ba€  <3, 2> ) 
MAT  Dav0mDau0+T4 
MAT  T4«T3*<Hb*e<3,3>) 
MAT  DavO*D*v0+14 

i 

MAT  Daul«TH<Dtal<3,l>> 
MAT  T4’»T2*<Hbal<3,2>> 
MAT  Daul«Davl+T4 
MAT  T4«T3*<Hbal<3,3>> 
MAT  Davl*Davl+T4 

MAT  Dau2=Tt* <Dta2<3, 1>> 
MAT  T4*T2*<Hba2<3,2>> 
MAT  Dav2«Dav2+T4 
MAT  T4==T3*<Hba2<3,3>> 
MAT  Dau2*Dav2+T  4 

I 

MAT  Dau3*TH  <Dta3<3,  1>> 
MAT  T4:»T2*<Hba2<3,2)> 
MAT  Dau3“Dau3+'!4 
MAT  T4:»T3*<I*ba:-<3,3>> 
MAT  Dav3-Dau3*T4 
I 

DISF 

SUBEND 


I  Compute  d<AV<0>^d< Bba < 1 > > . 


•  Compute  d<AV<»>  >^d<Bba<2> ) . 


!  Compute  d(AV(*>  >/'d<Bba<3>  > . 


!  Compute  d<AV<»>  >/'dCBba<4)  >  . 


Orbit 


We  use  Herrick's  "f  and  g"  solution  for  a  two  body  case  (see 
Reference  6)  to  update  the  satellite  and  earth  position  and  velocities. 

For  either  the  satellite  or  earth  we  set: 

i  / 

r0  =  (r„  •  r.o)  /2  (Xo,Yo»Z0)  =  initial  position 

=  (X§  +  Y§  +  z!)Vz 

Vo  =  (Vo  •  V0)  ^2  =  (ro  •  r0)  ^2  (Xo.?o,2o)  =  initial  velocity 

-  (its  +  n  +  n)l/2 

Do  =  r0  •  Vo 

=  X0Xo  +  Y0Yo  +  Z02o 
1/a  =  2/r0  -  Vo/u 
u  =  GM 

t0  =  initial  time 

In  the  current  version  of  this  program  we  have  set  both  orbits  to  be 
circular.  The  inclinations  of  the  earth  orbit  is  23.5°  and  the  satellite 
orbit  is  70°. 

To  obtain  the  position  and  velocity  of  either  body  at  some  later 
time,  t,  we  solve  the  following  equation  for  M  Ky  Newton's  method: 

u  ^2(t  -  to)a~3/2  =  M  -  (1  -  r0/a)sin  M  +  D0(l  -  cos  M)(ua) 

using  the  initial  estimate: 

M  =  u  ^2(t  -  t0)a"  ^ 2 . 

Then,  the  position  (X,Y,Z)  at  time  t  is: 

t 


1 
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where 

f  =  1  -  a(l  -  cos  M)/r0 
g  =  (t  -  to)  -  a  /z(M  -  sin  M)u'V2 

Also,  the  velocity  (X,Y ,1)  at  time  t  is: 


where  r  =  (X2  +  Y2  +  Z2)  ^2 
f  =  -(ua)  ^2  sin  M/rr0 
g  =  1  -  a(l  -  cos  M)/r. 
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**********•*"****»*'•*«***********•••««*******•*«******#•******•* 
•  * 

*  ORBIT  * 

*  * 
**»#»***#***'*#** »4#*« ft***************************************** 


16490  !  This  subroutine  computes  the  orbital  position  and  velocity  using 
16500  !  Herrick's  F  s.nd  G  solution.  <See  J.L.Junkins  Text) 

16510  ! 

16520  SUB  Orbit  <r,P<*>,V<*>,P0<*),V0<*)fT0,UfA,D0,R0> 

16530  OPTION  BASI  1 
16540  DIM  PI :3>, *2<3> 

16550  ! 

16560  X* 1 -R0  'A 
16570  Y-DOz-SbRCUsN) 

16580  Rho=3QR(U>  *<  T-T3)/'SQR<fl*fl*fl) 

16590  PhiaRho 
16600  Dphi®10 
16610  ! 

16620  FOR  1=1  TO  10  !  Find  Phi  by  Newton's  method. 

16630  Cphi “COS<Pii  ) 

16640  Sphi =S IN<Pai ) 

16650  IF  RBSCDphi :<lE-5  THEN  Got_it 
16660  Rhoc=Phi -X»Sphi +  Y*< 1-Cphi  > 

16670  Drdp=l-X*Cahi +'»*Sphi 
16680  Dphi  =<l?ho-?hoc  VDrdp 
16690  Phi =Ph i +  Dpai 
16700  NEXT  I 
16710  ! 

16720  PRINT  ’*#*»****»*  HELP  ***♦♦*#*#*  ORBIT  DID  NOT  FIND  PHI  !!!!!!'•!! 
16730  ! 

16746  Got  it:  !  Newton's  method  worked. 

16750  F=l-A*;i-Cahi  )<-R0 

16760  G-T-T0 -A*S3P<A'U)*<Phi -Sphi ) 

16770  MAT  P1-*<F)»P0  ! 

16780  MAT  P2:=<G)*V0  !  Update  position. 

16790  MAT  P=P1+P2  ! 

16800  I 

16810  R*SQROOT <  ’,  P)  > 

16820  Fd«-SQR<U*:i:*S|:hi/<R*R0) 

16830  Gd*l-A»< l-:phi )/R 

16840  MAT  Pi«<Fd)*P0  » 

16850  MAT  P2;*<Gd)*-V0  i  Update  velocity. 

16860  MAT  V-P1+P2  ! 

16870  i 

16880  SUBEND 
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Pair-it 

The  task  of  Pair-it  is  to  identify  measured  stars  with  specific 
catalog  stars.  We  do  this  in  two  ways.  The  first  method  compares  the 
cosine  of  the  interstar  angle  between  measured  star  pairs  with  the 
cosine  of  interstar  angles  of  catalog  star  pairs.  If  there  is  a  match 
we  perform  a  least-squares  correction  (by  calling  Least-1 )  to  refine  the 
attitude  estimate. 

The  second  method  to  match  stars  uses  the  improved  attitude  esti¬ 
mate  to  mathematically  project  all  the  sub-catalog  stars  onto  the  focal 
plane  and  then  compare  each  position  with  measured  stars.  We  require  at 
least  three  matches  to  confirm  the  attitude  found  by  least-squares.  The 
direction  cosines  and  measured  coordinates  for  each  confirmed  star  image 
(up  to  5  stars)  are  stored  in  an  array  and  returned  to  the  calling 
program  for  later  processing. 

The  confirmation  tests  discussed  above  require  an  error  tolerance 
between  projected  and  measured  stars  in  order  to  accept  or  reject  a 
specific  catalog  star.  The  technique  we  use  is  discussed  below.  We 
first  calculate,  for  one  star  of  the  initial  matched  pair,  the  angular 
size  of  twice  the  estimated  one-sigma  error  (10%  pixel)  as  seen  from 
the  midpoint  between  images  and  perpendicular  to  the-  line  connecting  the 
two  stars.  Then,  for  stars  more  distant  than  one-half  the  pair  separation, 
we  scale  the  angle  by  the  distance  from  the  midpoint  in  order  to  get  the 
tolerance  for  each  star.  For  nearer  stars  we  simply  use  the  estimated 
t.wo-sigma  image  error.  This  technique  helps  to  account  for  rotation 
errors  due  to  displacements  of  one  or  both  stars  of  the  initial  pair, 
normal  to  the  separation  vector.  (See  Figure  A10.3). 
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tan  e  -  e  -  2a/p 

where  p  =  one-half  of  separation  between  the  initial  matched  pair 
and  a  =  estimated  error  (1 -sigma)  in  position  of  star  centroid. 
2a1  =  ep'  (for  p'  >  p) 

2a"  =  2 a  (for  p"  _<  p) 

where  p'  and  p"  are  distances  from  midpoint  (*c,yc)  between 
stars  of  initial  pair. 

Figure  A10.3:  Calculation  of  error  tolerance  values  to 


be  used  for  matching  measured  and  calculated 
star  images. 


**********  **•♦***»«•*#«  a*************************  *************** 

*  * 

*  P  A  1  R  -  I  T  * 

*  * 

****************  ********************************************** 

4620  I  Pairit  oairs  stars  from  the  catalog  and  stars  from  Proc .  A  to  f'ird 
4630  !  the  or  i  eit  at  i  on  of  the  vehicle. 

4640  SUB  Pal r_i t < SHCRT  Fovc<*),REAL  Nf ovc , Fovm< * > , Nf ovm, Bvn<* > , Av< * > , To  1 , S i gxy , 
FI  ,  14 ,  F 1  d  (  *  )  ,  Kmax  ) 

4650  OPTION  BASE  1 

4660  DIM  Vn:3,3),fln<3,3),Sb<4> 

4670  DIM  Xx:2>, Oi st <5> , L<3> , Cov<4, 4> , T<3, 3> 

4680  SHORT  Cosm<< 5> , Epsp<45> 

4690  INTEGER  Ind>:<45,2) 

4700  RAD 
4710  ! 

4720  MRT  Sb=Bvn  !  Save  original  values  of  Euler  parameters. 

4730  CosmaX'<COS(f'I/180) 

4740  Cosmin«COS<l  1*FI/'180> 

4750  Ll-1 
4760  ! 

4770  Mm=Nf ovm+Nf ovm- 1  !  Maximum  sum  of  indices  for  measured  stars. 

4780  PRINT  USING  "/fK"; "Table  of  Cos(Theta)  for  Measured  Stars." 

4790  PRINT  IJS I  NS  For  m2 

4800  Form2l  IMAGE  "  Star  Star  CosCThetaV 
4810  ! 

4820  FOR  M»3  TO  Mm  !  Loop  over  all  possible  sums  of  indices  for 

4830  J1«<M-1>'«:  !  measured  stars. 

4840  FOR  J»1  TO  J1  I  Loop  over  all  pairs  whose  indices  sum  to  M. 

4850  K*H-J 

4860  IF  tONfc.vm  THEN  GOTO  Nextj 

4870  Co*m<L  1  *Fc  vm<  J ,  3>*Fovm<K ,  3>*<Fovm<J,  1 )  *Fovm<K ,  1  >  +  Fovm<  J ,  2  >  *Fovn  <K ,  2  )  + 

1> 

4880  IF  Cos«< LI ) >Cosmax  THEN  GOTO  Nextj 

4890  PRINT  JSING  Forml J J; K; CosmCL  I) 

4900  Forml:  [MAGE  2X, DDD, 2X, DDD, 3X, D. DDDDDD 

4910  Indx<Lt , 1 >* J 

4920  Indx<Ll,2)»K 

4930  L1=L1+1 

4940  Nextj:  NEXT 

4950  NEXT  M 

4960  Imax*Ll-l  !  Total  number  in  list. 

4970  ! 

4980  Mm=Nfovc+Nfc<vc- 1  !  Maximum  sum  of  indices  for  catalog  stars. 

4990  PRINT  USING  "Begin  Pairing  Catalog  Stars  and  Comparing  To  Measured  P 

airs. 11 

5000  PRINT  USING  "/K , X, DDD" ; "Number  of  stars  from  cat al og: " , Nf ovc 
5010  PRINT  USING  Form2 
5020  ! 

5030  FOR  M»3  TO  Mi*  !  Loop  over  all  possible  sums  of  indices  of 

5040  J1 =<M-i: /2  !  catalog  stars. 
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5050  FOR  Jj=)  TC  J1  !  Loop  over  all  pair*  whose  indices  sum  to  M. 

5060  K»M-J, 

5070  (F  K>Nfov.c  THEN  GOTO  Nextjj 

5080  Cost  »£i 

5090  FOR  .*=1  TO  3 

5100  Cost “Ccst+Fovc < Jj , L)»Fovc <K, L)  !  Compute  dot  product. 

5110  NEXT  L. 

5120  PRINT  USING  Forml ; J j ; K; Cost 

5130  IF  Cost  >Cosmax  THEN  GOTO  Nextjj 

5140  (F  C3£t<Cosmin  THEN  GOTO  Nextjj 

5150  FOR  I i =1  TO  Imax 

5160  IF  FiBS(Cost-Cosm<  I  i  >  X'Tol  THEN  Hatch  !  Test  for  match. 

5170  Next i i :  4EXT  I i 

5180  Nextjj:  4I.XT  Jj 

5190  NEXT  H 
5200  ! 

5210  Failed:  PRINT  "»*#******♦*  NO  PAIR  MATCH  FOUND  FOR  THIS  FOV  *************•' 
5220  Kmax-0 
5230  SUBEXIT 
5240  ! 

5250  Hatch:  PRINT  LSING  ">>>>>  Catalog  Pair  Hatched  with  Measured  Pair  < 

<<<<" 

5260  Kma>;s2 

5270  Iml*:Incx<I  i  ,  1  ) 

5280  Im2*:Incx<  I  i  ,  2) 

5290  Icl-Jj 

5303  I  c  2S:K 

5310  IF  F  ovrr  <  Iml ,  4  XFovmC  lm2,4)  THEN  Okm  *  Test  magnitude  order, 

5320  1 1*  I  ir 1 

5330  Iml=Im2  !  Switch  magnitude. 

5340  Im2«Is 

5350  Okm:  IF  Fo  vc  <  Ic  1 , 4XFovc  <  Ic2, 4>  THEN  Okc  I  Test  magnitude  order, 

5360  Is*Icl 

5370  Ic l*Ic2  !  Switch  magnitude. 

5380  Ic2-Is 

5390  Okc:  PRINT  JSINC  "/K" ; "Measured  pair:" 

5400  PRINT  JSINC  Form2 

5410  PRINT  JSINC  Forml ; Iml ; Im2J Cosm< Ii > 

5420  ! 

5430  !  Compute  separation  of  pair/2. 

5440  I 

5450  Rhol2*3QR<  <F  ovrr  <  Iml ,  1  >-Fowm<  I  m2,  1  >  > A2  +  <Fovm<  Iml ,  2>-Fovm<  I  m2, 2)  >A2>/£ 

5460  ! 

5470  !  Compute  angular  extent  of  2*sigma  error. 

5480  ! 

5490  Eps"2*3i  gxx<Fl  *Rhol2> 

5500  Xcent*  IFovmt Iml , 1 >+Fovm< Im2, 1 > >/2  !  Compute  average  position. 

5510  Ycent*  IFovmt Iml , 2>+Fovm< I  m2, 2>  >/2 
5520  ! 

5530  F 1 d< 1 ,  l >*F Due ( Ic 1 , 1  > 

5540  FI d< 1 , 2>*F  ovc ( Ic 1 , 2> 

5550  FI d< 1 , 3>“F svc  < Ic 1 , 3) 

5560  F 1 d  < 1 , 4 ) *F  sum ( I m 1 , 1 > 

5570  FI  d<  1 , !5>»F svm<  Iml ,  2>  ! 

5580  F 1 d<2, l > *F ovc < Ic2, 1 )  !  Fill  array  with  data  for  paired  stars. 
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5590  F 1  d  <  2 , 2 ) *F avc  <  I c 2 , 2 )  I 

5600  F1d<2,3)=F ovc  <  I c 2 , 3 > 

5610  Fld<2,4>zF5vm<Im2, 1) 

5620  Fld<2,!5)»F3vm<Im2,2> 

5630  ! 

5640  !  PeM'orrr  1  east-squares  differential  correction. 

5650  ! 

5660  CALL  L>?ast_l<B'.n<*>,Ao<*>,Fld<*),Km*x,W,Cow<*>,  Converge) 

5670  IF  Converge*©  THEN  Next  i  i  I  Try  another  pair - this  one  didn't  work. 

5680  ! 

5690  !  Search  for  confirming  stars. 

5700  ! 

5710  CALL  Dircoit.<Bvn<#>,Vn<*>,0,T<*),T<*>,T<*>,T<*>> 

5720  MAT  An*Av*7r. 

5730  KmaxsxKmax 
5740  Ki»ax*0 
5750  MAT  F 1 d*Z£  ? 

5760  PRINT  US  I  NS  'V,K" Test  For  Additional  Stars'1 

5770  PRINT  USIN  j  "K";"x<ca1c>  x(meas)  y<calc)  y(meas)  Dx  By" 

5780  ! 

5790  FOR  JM  TO  Nfocm 

5800  !  Compete  naximum  deviation  allowed  for  each  measured  star. 

5810  Rho*'5QR<  <F'ov*  <  J,  1  )-Xcent  W-KFovmC  J,  2>-Ycent  >  A2> 

5820  Epsp . J  >* 1AX<  E ps*Rho,2*Sigxy^Fl  ) 

5830  NEXT  . 

5840  ' 

5850  FOR  N-l  TO  Nfovc 
5860  FOR  I S  *  1  TC  3 

5870  I. <  I s ) *;Focc  <N,  Is) 

5880  NEXT  Is 

5890  CALL  Pnoeqr <L<») , An<«) , Xx< 1 > , Xx<2> > 

5900  FOR  J-l  TO  Nfovm 

5910  R1«ABS<X> < 1 )-Fovm< J, 1 > )  !  Deviation  in  x. 

5920  IF  Ri:Epsp<J)  THEN  Next_j 

5930  R2*ABS<X> <2)-Fovm( J, 2) )  !  Deviation  in  y. 

5940  IF  R2/Epsp<J)  THEN  Next_j 

5950  !  Confirming  star  found. 

5960  PRINT  LSING  "6<MD. DDDD, XX) " ; Xx < 1 ) *F 1 , FovmC J , 1 > *F 1 , Xx < 2 > *F 1 , F ovm< J , 

2)*F1 ,R1*F1 ,R2*F1 

5970  I  PRINT  LSING  "2<MD.  DDDD, XX ) " ; R 1 *F 1 , Epsp < J ) *F 1 , R2*F 1 , Epsp< J ) *F 1 

5980  Kma>:*K«ax+l 

5990  FI dOCmax, 1 >=Fovc<N, 1 ) 

6000  FI d< Kmax, 2)*Fovc <N, 2) 

6010  FI  d<  Km«.x,  3)*Fovc  <N,  3)  !  Save  data. 

6020  FI  d<  Km«.x,  4)*Fovm<  J,  1 ) 

6030  FI  d<  Kms.x,  5)"Fovm<  J,  2) 

6040  ! 

6050  IF  LmaxzNfovm  THEN  No_more  !  We've  matched  all  measured  stars. 

6060  IF  Kma**5  THEN  No_more  !  We  have  enough  confirming  stars. 

6070  GOTO  N«xt_star 

6080  Next_j!  NEXT  J 

6090  Next  star:  NE) T  N 

6100  “  ! 

6110  No_more :  Ir  Kmax>2  THEN  SUBEXIT 

6120  PRINT  OSIN;  No  additional  stars  found  **  Assume  false  match" 
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6130  Kmax*0 

6140  PRINT  IJSIN;  “/K " ; "Rep 1 ac e  new  values  of  Euler  parameter*  with  old  u«lues  a 
nd  continue  pairing." 

I  6150  MPT  Bun=Sb  !  Replace  new  Euler  parameters  with  old  values. 

I  6160  GOTO  N<?xtii  !  Continue  pairing — assume  this  orientation  isn't  correct. 

6170  SUBEND 

I 

!  I 
I 

r 

i 

i 
i 

i 

* 

i 

i 

i 
i 
i 
i 
i 
i 
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Perturb 

This  subroutine  computes  a  time  varying  perturbation  to  Euler 
parameters.  We  have  used  simple  sinusoidal  variations  added  to  the 
nominal  values.  Input  data  consist  of  the  orbital  frequency,  time,  the 
nominal  values  of  the  Euler  parameters  and  the  amplitude  and  frequency 
of  the  variations.  The  perturbed  Euler  parameters  are  returned  to  the 
calling  program. 


t 
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I 

I 

I 

I 

! 
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#*#*****•*******» ***«#*****##**#***#*•********#**•****«*#•*«** 
*  • 

»  PERTURB  * 

*  # 


*«**•*•**•**'*  ***»«•**«********  ********************************* 


7810  SUB  Pertur SHCRT  Bnom<*> , E < * > , N< * > , REAL  Omega, Dt , B< *> > 

7820  OPTION  BASE  1 
7830  I 

7840  B< 1 )>Bnon< 1 J  +E< 1 >*COS<N< 1 >#Omega*Dt > 

7850  B<2>“Bnom< 2J +E<2>*SIN<N<2>*0mega*Dt>  !  Perturb  the  nominal 

7860  B<3>*Bnom<  3', +E<3)*C0S<N< 3>*0mega*Dt  >  I  parameter*. 

7870  B<4)»Bnom< il ♦E<4)#SIN<N<4)*0mega*Dt  > 

7880  ! 

7890  Mag=*SQR<DOr<  B,  I ) )  !  Normalize  the  new  Euler  parameters. 

7900  MAT  B»:3/<Mag) 

7910  t 

7920  SUBEND 


Euler 


This  small  subroutine  uses  the  stellar  colinearity  equations  to 
compute  image  coordinates.  As  input  it  needs  the  star  direction  cosines 
and  the  3  *  3  rotation  matrix.  This  routine  returns  the  x  and  y  coor¬ 
dinates  normalized  by  lens  focal  length: 


X 

L, 

CjJL 

+  L2 

C12 

+  1-3 

Cl  3 

f  ~ 

Li 

c  3  1 

+  L2 

C32 

+  l3 

C3  3 

Y  . 

Li 

C21 

+  }"2 

C2? 

+  l3 

C33 

T  ~ 

ET 

C31 

+  L2 

C32 

+  l3 

£33 

where  are  elements  of  the  rotation  matrix  and  are  star  direction 
cosines. 


*»**•***»***'»#•*»*<##«*##**«*##•#*#****•##****#************##•* 


* 

* 

* 


P  H  0  E  Q  N 


« 

* 


**************** *«'**«**•*****#**** **************************** 


8170  !  Computes  >:,y  coordinates  for  a  particular  star. 

8180  SUB  Phoeqn<l.<*> ,  C<*) ,  Xpho,  Ypho> 

8190  OPTION  BASE  1 
8200  DIN  PhoC3> 

8210  ! 

8220  HAT  Pho»C*.  I  Rotate  direction  cosines  into  new  frame 

8230  Xpho-Pho<l>/Phc<3> 

8240  Ypho«Pho<2)/Phc<3> 

8250  < 

8260  SUBEND 
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Post-mult 

The  function  of  this  subroutine  is  to  post-multi ply, by  a  rotation 
matrix,  a  set  of  4  matrices  which  are  the  partial  derivatives,  with 
respect  to  Euler  parameters,  of  a  second  rotation  matrix.  For  example, 
for  field  of  view  A  we  need  the  partial  derivatives  of  the  AN  rotation 
matrix  with  respect  to  Bgj|.  Subroutine  Mat-av  computes  the  partials 
of  AV  with  respect  to  Bg^.  Then,  since  AN  =  AV  •  VN 

3AN  _  3AV  ,#M 
<\n  *  YN 


where  the  partials  indicate  derivatives  of  matrix  elements. 
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****#***•**•'*••*  M'ft««**«***ft*»**ft*»*«********«*#**********»*** 
*  # 

•  POST  MULT  ♦ 

*  ~  * 


**»*•*•«**•«**** 

11260 

SUB 

Poat  m 

11270 

OPTION  BPS 

11280 

DIM 

T  <  3 , 3  > 

11290 

! 

11300 

MOT 

t«:dci# 

11310 

MPT 

Dc  l-T 

11320 

MPT 

T«)c2# 

11330 

MPT 

Dc;2*T 

11340 

MPT 

T-!)c3# 

11350 

MPT 

Dc3*T 

11360 

MPT 

T*3c4» 

11370 

MPT 

Dc4*T 

11380 

! 

11390 

SUBEND 

I  Post -mul  t  i  pi  y  d»riv*ttv«  matrices  by  rotation  in 


! 


'170 

Pre-mult 

This  subroutine  is  similar  to  Post-mult.  In  this  case,  we  pre- 
multiply  partial  derivative  matrices  by  a  rotation  matrix.  For  example, 
since  AN  *  AV  •  VN, 

M  .m- 

3bvn  3Bvn 

where,  it  will  be  recalled,  the  partial  derivatives  are  computed  by 
Dircosb. 


1 
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*»***•*«*«**'****  »«*•«********#**»*•»*** *********************** 
*  * 


*  PRE_MULT 

♦ 


# 

# 


•ft************************************************************ 


11040 

SUB 

Pnt  mul t  <C<*> 

,Dcl<*>,Dc2<*),Dc3<*>,Dc4<*>> 

11050 

OPTION  BASE  1 

11060 

Old 

T<3, 3) 

11070 

i 

11080 

MAT 

T«*C*Dc  1 

11090 

MAT 

Dc  l«T 

11100 

MAT 

T*i:*Dc  2 

11110 

MAT 

DC.2-T  ! 

11120 

MAT 

T»i;«Dc3  ! 

Pre-mul t i pi y  derivative  matr 

11130 

MAT 

Dc3«T  1 

11140 

MAT 

T«C*Dc4 

11150 

MAT 

Dc4«T 

11160 

i 

11170 

SUBEND 

*  rot  at i or  mat 
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Proc-b 


This  subroutine  controls  the  various  functions  of  Process  B. 

As  input  we  need  the  Euler  parameters  describing  the  vehicle  frame 
orientation,  B^.  and  those  describing  the  interlock  between  camera 
frames  A  and  B,  Bg^,  along  with  the  variance  to  associate  with  BB^  in 
the  Kalman  filter  update.  Usually,  both  sets  of  Euler  parameters  are 
updated  by  Process  B  before  they  are  returned  to  the  calling  program. 
Process  B  also  requires  the  coordinates  of  each  measured  star  in  FOV (A) 
and  FOV(B)  and  returns  the  calculated  coordinates  for  stars  matched  with 
measured  stars. 


The  first  step  in  this  subroutine  is  to  compute  the  rotation 
matrices  BA  from  BBA»  from  which  we  calculate  AV,  and  matrix  VN  from 
Bvn-  The  unit  vector  for  the  boresight  of  FOV(A)  is  contained  in  the 
last  row  of  matrix  AN  =  AV  •  VN  and  is  used  by  Access  to  retrieve  a 
subcatalog  of  stars  near  this  boresight.  Pair-it  is  then  called  to 
match  catalog  and  measured  stars  and  to  update  BVN-  We  then  compute 
VN  again  and  calculate  BN  =  BA  •  AV  •  VN.  The  boresight  unit  vector, 
the  last  row  of  BN,  is  used  by  Access  to  again  obtain  a  sub-catalog. 
Pair-it  once  again  matches  measured  and  catalog  stars  and  updates 

eVN‘ 

There  are  several  possible  paths  for  Process  B.  If  either  FOV 
contains  fewer  than  three  stars,  we  skip  any  attempt  to  match  stars 
in  the  FOV  (we  need  at  least  three  stars  to  confirm  an  orientation). 
Should  FOV(A)  and  FOV(B)  each  contain  fewer  than  three  stars,  we 
declare  a  failure  condition  for  Process  B  and  return  to  the  calling 
i^gram.  In  this  case,  no  attempt  is  made  to  update  BVN  or  BBA  (and 


no  Kalman  filter  update  is  needed);  the  integrated  values  of  3^  and 
covariance  matrix  are  used  to  start  the  analysis  of  the  next  Process  A 
data  set. 


If  only  one  FOV  contains  a  sufficient  number  of  stars,  we  call 
Least-1  and  use  up  to  5  stars  in  that  FOV  to  update  3^  (Pair-it  updates 
using  only  2  stars).  Note  that  the  interlock  parameters,  3BA,  are 
not  updated;  the  same  values  are  used  on  the  subsequent  data  frame. 

Usually  there  are  a  sufficient  number  of  stars  in  both  FOV(A)  and 
FOV(B)  (more  than  2  in  each)  so  we  can  correct  both  3VN  and  3^.  This 
is  done  by  subroutine  Least-2. 

If  Bvn  has  been  updated,  then  we  compute  calculated  image  coordinates 


for  all  matched  stars  and  return  these  to  the  calling  program  along  with 
the  4  x  4  covariance  matrix  associated  with  BWM. 
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**»*4*«*«***'t***  »*"**«***••*********#••***•*•«***#***###**«**** 

*  • 

*  PROC-B  * 

*  * 

************  ******************************************************** 

3020  SUB  Proc_b<  *;2, 1  vn<  *  )  ,  Bba<  *  )  ,  Voc  <  *  >  ,  Nf  ouma,  Nf  ovmb ,  Ka,  Kb,  U,  Si  gxy ,  SHORT  X  y  rn  a  < 
* ) , Xymb<*> , Xyc a<*),Xycb<*>, REAL  Cov8<  *> ,Pba<*>,Qba<*),8balsq<*>> 

3030  !  T.  STRIKWEFDA  .  9  JUNE  1980. 

3040  !  This  subprogram  is  process  B  of  Star  Mars.  This  version  uses  Euler 

3050  !  parameters-  ard  recovers  interlock  Euler  parameters. 

3060  OPTION  BAS;  1 
3070  DIM  Bore < 3 ) 

3080  DIM  Vn:3,3>, Av< 3 , 3) , Ba< 3 , 3 > 

3090  DIM  An:3,3),Bn<3,3>,Bv<3,3>,Tn<3,3> 

3100  DIM  Flda<5,5>,Fldb<5,5>,Fovm<10f4> 

3110  DIM  Kal<4, 4; , Lt a<4 , 4 > , Bbae<4 ) , T3< 4 > , T4< 4 > 

3120  DIM  Cov<4, 4: 

3130  SHORT  l-ovst<  106,4) 

3140  COM  Vg!3, 3), INTEGER  Table<529,2> 

3150  RAD 

3160  REDIM  Cov3<8,£> 

3170  ! 

3180  F=70  !  Some  constants. 

3190  Fe=2 . 42536 

3206  Fl-F>Fe 

3210  Tol»9.25E-6 

3220  Radius=5.7'*PI^180 

3230  Sigmaaie^J/lEO 

3240  ! 

3250  !  Calculate  interlock  matrices  BA  and  flV. 

3260  ! 

3270  CALL  Dircost.<Bta<*),Ba<#>,0,Tn<*),Tn<*>,Tn<*),Tn(*>> 

3280  CALL  Mat_aj<Ba<*),Tn<*>,Tn<*),Tn(*),Tn<*>, Av< * > , 0, Tn< * > , Tn< * ) , Tn< * )  ,  Tn< * > ) 
3290  Ka=0 
3300  Kb*0 
3310  ! 

3320  PRINT  US  IN:  'Vk";"  Start  for  F0V<R>“ 

3330  REDIM  lrovm<Mfovma, 4) 

3340  IF  NfoumaO  THEN  Fov_b 
3350  FOR  [»1  TO  Nfovma 

3360  Fovm< I , *■ I , 3)  !  Normalize  image  coord,  by  focal  lencth. 

3370  Fovmtl, 1 >=Xyma< I , 1)/F1 

3380  Fount <  1 , 2)*Xyma<  1 , 2>/Fl 

3390  Fount  < 1 , 3)*l/SQR<Fovm< I, l)r2+Fovm<I,2>r2+i> 

3400  NEXT  I 

3410  CALL  Dirco»b<Bl»n<*>,Vn<*>,0,Tn<*>,Tn<*>,Tn<*),Tn<*)> 

3420  MAT  An;sAv*  Jri 
3430  FOR  (*1  TO  3 

3440  Bor«<  I  )*-An<3, 1  >  !  Boresight  unit  vector  for  FOVCA). 

3450  NEXT  I 

3460  PRINT  US  IN  3  Form5; "Boresi ght  direction  cosines  for  FOV<A> : “ , Bore<*> 

3470  Form5:  IMA^E!  /K'3<MD. DDDDDD, X) 


L 
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3480  CALL  fie ces»<#2,Nf ova, Bor e< *> , Sigma, Radius, Voc<*>,Fowst<»>> 

3490  CALL  Pair_it<Fcost<*>,Nfowa,Fowm<*>, Nf ovma, Bwn<*> , Aw<*> , Tol , Si gxy , F 1 , U, FI d 
a<  *> i Ka> 

3500  Ka2*Ka+Ka 

3510  BEEP  !  Dou  with  FOV<A>. 

3520  ! 


.3530  Fow  b:  ! 

3540  PRINT  USIN3  Start  for  FOV<B>" 

3550  IF  Nfowmb<3  THEN  Options 
3560  ! 

3570  CALL  D  i  rco sb<Bt n<  *>  ,  Vn< * >  ,  0 ,  Tn<  * >  ,  Tn<  * >  ,  Tn<  * )  ,  Tn<  * >  ) 

3580  CALL  Dircosb<Bta<*>,B*<*>,0,Tn<*),Tn<*>,Tn<*),Tn<*)> 

3590  MAT  Bv=«8a*1u 
3600  MAT  Bn=Bv*fri 
3610  FOR  1=1  TO  2 

3620  Bore< I : =Br <3, I >  !  Boresight  unit  utctor  for  FOV(B>. 

3630  NEXT  I 

3640  PRINT  IJSIN j  For m5; " Bores i ght  direction  cosines  for  FOV( B> : " , Bore (*> 

3650  REDIM  FovmCHfocmb, 4> 

3660  ! 

3670  FOR  1=1  TO  Nfocmb 

3680  Fowm<  1 ,  4)  =Xymb<  1 , 3)  !  Normalize  image  coord,  by  focal  length. 

3690  Fovm<I, i:=Xymb<I, 1>/F1 

3700  Foum<  1 ,  2'.  =Xy  mb<  1 , 2  >/Fl 

3710  Found,  3:=lrSQR<Fowm<I,  1  >''2+Fowm<I ,  2>A2+1  > 

3720  NEXT  I 
3730  ! 

3740  CALL  Ai:cess<#2,Nfowb,Bore<*>,Sigma,Radius,Voc<0,Fovst<*>> 

3750  CALL  Pair  i t <Fc vst < * ) , Nf ovb, Fovm< * > , Nf ovmb , Bvn( * > , Bv< * > , To  1 , S i gxy , F 1 , W , F 1 d 
b<*),Kb> 

3760  Kb2=Kb>Kb 
3770  BEEP 
3780  ! 


3790  Options:  ! 

3800  IF  <Ka>2>  3ND  <Kb>2> 
3810  IF  <Ka:3)  WB  <Kb<3> 
3820  REDIM  Co^8<4,4) 

3830  IF  <Ka>2)  3HD  <Kb<3> 
onoerge) 

3840  IF  <Ka<3>  3ND  <Kb>2) 
onverge) 

3850  ! 

3860  GOTO  Save  -e-sults 
3870  ! 


THEN  Combine  !  Do  least-squares  for  two  FOV. 

THEN  Fai led  !  PUNT!  !  ! 

THEN  CALL  Least_l < Bvn< * > , Av< *> , F 1 da< * > , Ka, W, Cot  8 < * > , C 
THEN  CALL  Least  1 <Bvn<* > , Bv< » > , F 1 db< * > , Kb , W , Cov 8< * > , C 


3880  Combine:  ! 

3890  ' 

3900  MAT  Bbae*Bo<t  !  Saue  estimated  interlock  parameters. 

3910  CALL  L*rast  2<  Bv. n< # ) ,  Bba< *> ,  Ka,  F 1  da< *  >  ,  Kb,  F 1  db<  * > ,  W,  Cov8<  * ) > 

3920  MAT  Bba1sq>i:ba 

3930  !  Perform  Kalman  filter  update  for  interlock  parameters. 

3940  FOR  I- l  TO  < 

3950  FOR  J=1  TO  4 

3960  Lbad ,  >Cc v8<4*I , 4  + J  > 

3970  NEXT  J 

3980  NEXT  I 
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3990 
4000 
4010 
4020 
4030 
4040 
4050 
4060 
4070 
4080 
4090 
4100 
4110 
4120 
4130 
4140 
>  > 

4150 

4160 

4170 

4180 

4190 

4200 

4210 

4220 

4230 

4240 

4250 

4260 

4270 

4280 

4290 

4300 

4310 

4320 

4330 

4340 

4350 

4360 

4370 

4380 

4390 

4400 

4410 

4420 

4430 

4440 

4450 

4460 

4470 

4480 

4490 

4500 

4510 

4520 

453* 


! 


MAT 

Pba=3ba+Cba 

1  Get  covariance 

matrix  at 

this  time. 

MAT 

MAT 

Kal *.ba+Fba 
LbaMMVCKal ) 

MAT 

MAT 

Kal *sba*Lba 
T3*B3a-Btae 

1  Kalman  gain 

matr i x. 

MAT 

MAT 

T4=Ka1*TC- 

3ba=Bbae+T4 

!  Corrections 

t  0 

interlock 

parameters. 

MAT 

MAT 

Lb  a*  <a1  *F  ba 
Pba*sba-Lba 

!  Corrections 

to 

covar i ance 

matr i x. 

Save_reiul t »:  ! 

CALL  Dir:osb<Bvn<*>t Vn<*>,0, Tn<* > , Tn<* > , Tn<* > , Tn<#> ) 

CALL  Di r :osb<Bba< »> ,Ba<»>,0,Tn<*>,Tn<*>,TnOO,Tn<»>> 

CALL  Mat_av<Ea<*>,Tn<*>,Tn<*>,Tn<*>,Tn<*>,Av<*>,0,Tn<*>,Tn<:*>,Tn<*>,Tn<# 

MAT  An=A v*  Vn 
MAT  Xyca  =  I!ER 
IF  Ka*0  THEN  Save_b 
!  ” 

FOR  KM  TO  K«.  !  Calculate  image  coord,  for  each 

FOR  1*1  TO  3  I  matched  star. 

3ore<l >=Flda<K, I> 

NEXT  I 

CALL  Pioeqr  < Bore < * > , An< * > , X, Y > 

Xy<:  a<K,  1  )=>< 

Xy.:a<K,2>M 
NEXT  K 

I 

MAT  Xyca*Xyc«.*<Fl  ) 

Saue_b:  ! 

MAT  3n=Ba*An 
MAT  Xycb=2!ER 
IF  Kb*0  THEN  End 
; 

FOR  ICM  TO  Kt 
FOR  1=1  TO  3 

3ore<l >=F 1 db(Kt I) 

NEXT  I 

CALL  P ioeqr < Bore < * > , Bn<  *> , X, Y> 

Xy.:b<K,  J  >»>■ 

XycbCK, 2>*V 
NEXT  K 

MAT  Xycb«Xycb#<Fl > 

! 

Form  1 :  IMA3E!  K/'4(MD.  DDDDDE,  X)/ 

For»4:  IMA3E.  K,  X,DD/10<2<MD.DDDB,X>/> 

Ends  ! 

SUBEXIT 

! 

Failed:  PRINT  "****###»#  PROCESS  B  FAILED  ######«#*###*###" 

PRINT  "Fewer  than  3  stars  in  each  FOV.  No  attempt  to  perform  " 
PRINT  " 1  east-squares  correction.  Use  old  values  for  orientation." 
GOTO  Save  results 

SU1END 


I 


The  subroutine  integrates  both  the  state  differential  equations  and 
the  matrix  Riccati  equation,  using  Runge-Kutta  methods.  As  discussed 
in  Appendix  8,  we  partition  the  Riccati  equation  into  four  parts  and 
only  two  of  these  need  to  be  integrated  numerically. 

Both  of  the  equations  are  integrated  with  two-cycle  Runge-Kutta 
methods.  However,  since  the  covariance  matrix  should  be  relatively 
constant  in  steady-state,  we  use  a  step  size,  for  the  Riccati  equation, 
equal  to  the  time  between  data  frames  (currently,  30  seconds).  The  step 
size  for  the  state  integration  is  much  smaller  (currently,  0.5  sec  or 
60  steps  between  frames). 

The  first  task  in  this  subroutine  is  to  partition  the  covariance 
matrix  and  evaluate  the  right-hand-side  of  the  Riccati  equation  at  the 
start  of  the  time  interval.  We  then  integrate  the  state  equation, 
through  repeated  use  of  two-cycle  Runge-Kutta  methods,  until  we  reach 
the  end  of  the  interval.  The  right-hand-side  of  the  Riccati  equation  is 
again  evaluated,  this  time  at  the  end  of  the  interval,  and  the  integrated 
covariance  matrix  calculated. 
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**###*##**##■♦###  »*•**«  ##*########*#########*##*######*#  ***#»•»* 

*  * 

*  R  U  N  C  E  * 

»  * 

•«*«#***«#*»-*#**»**#«***»##**«»****#*•#***•*•***##****#******* 

13600  SUB  Runge<TI.  , D« 1 t , Step, SHORT  W1  <  #) ,  W2<  #>  ,  W3<  #> ,  REAL  Xk  <  *  >  ,  P  C  *>  ,  Q(  #  >  ,  S  i  gb> 
13610  OPTION  BPS:  1 

13620  DIM  X<4>,Pll<4,4>,P21<3,4>,Pllp<4,4>,P21p<3,4>,P22<3,3> 

13630  DIM  D1 14), <1 < 4 , 4 > , L 1 < 3, 4 > , Sunk <4, 4  > , Sum  l <3, 4) 

13640  DIM  S1'4)I^11<4,4>,R12(4,3>IM<3>,B(3> 

13650  DIM  Q2:><3,  3J  ,P22p<3,3> 

13660  ! 

13670  MAT  Q2;2-ID4 

13680  MAT  Q22-Q22*<  <$  i  gb-'30>,'2>  !  Factor  of  30  may  be  changed  to  tune  Kalman 

13690  !  filter  for  bias  recover. 

13700  DISP  “Rungt1 
13710  ! 

13720  T-Tk 

13730  FOR  I*  l  TO  *• 

13740  FOR  1*1  TO  4 

13750  PI i < 1 , j; »P< I , J)  I  Get  upper  left  4x4  portion  of  cov.  matrix. 

13760  NEXT  J 
13770  NEXT  I 
13780  ! 

13790  FOR  I* l  TO  3 
13800  FOR  1*1  TO  4 

13810  P2 1  <  I ,  J.'  *P(4+I ,  J)  I  Get  lower  left  3x4  portion  of  cov.  matrix. 

13820  NEXT  J 
13830  NEXT  I 
13840  ! 

13850  FOR  I* l  TO  3 

13860  B<  I  )!*Xk  <  4+1  >  I  Get  current  bias  values. 

13870  FOR  J* 1  TO  3 

13880  P2;2<I,  J:*P<4+I,4+J>  !  Get  lower  right  3x3  portion  of  cov.  matrix. 

13890  NEXT  J 
13900  NEXT  I 
13910  ! 

13920  REDIM  .<<4),>:k<4> 

13930  MAT  X*Xk 
13940  MAT  PI lp*Pll 
13950  MAT  P2 l p*P  2 1 
13960  MAT  P2;>p-P22 

13970  !  Confute  time  derivative  of  covariance  matrix  at  time  t(initial). 

13980  W<1>»WI<1> 

13990  W<2)»W:2<1)  !  Use  gyro  rates  from  beginning  of  interval. 

14000  M<3)*W3<  1  > 

14010  • 

14020  CALL  Mata<l,W<e>,Xk<#>,Ail<*>,A12<*>) 

14030  CALL  D*r i v<Pl lp  <*> , P2Ip<*> , P22p<*> , Q<*> , A1 1 <•> , AI2<#> , K1 <*> , LI <*>  > 

14040  • 

14050  MAT  Sumk*Kl 
14060  MAT  Sum 1 -LI 


14070  MAT  A1 l*Kl *<  Step) 

14080  MAT  PI tp*Pl 1+A1 1 
14090  MAT  A1  l*Ll »< Step) 

14100  MAT  P2lp*P21 +A1 1 
14110  REDIM  A  11(4,4) 

14120  MAT  P22p=Q22*(Step) 

14130  MAT  P2;2p®P22+P22p 
14140  ! 

14130  !  Begin  iut«  integration. 

14180  ! 

14170  MAT  M*N-B  I  Subtract  bias  values. 

14180  CALL  MitaO,M<«>,X(*>lAll<0,A12<t)) 

14190  ! 

14200  FOR  It‘*2  TD  Step^Delt+1  !  This  is  a  series  of  2  -  step  Runge-Kutta 
14210  MAT  !)l*All#Xk  t  i  ntegrat  i  ons. 

14220  MAT  :J1«(D«  1t)*Dl 
14230  MAT  X«Xk*Sl 

14240  W(l)«Wl(It ) 

14230  W(2)-W2(It)  !  Get  gyro  rates  for  interval. 

14260  W(3>:*W3(It)  !  Note:  These  are  measured  rates  in  gyro  fri.ms 

14270  MAT  M=W-B  !  Subtract  the  biases. 

14280  CALL  Mata<0,KO,X(*>,All(*>,A12(*>> 

14290  MAT  ;51«A11*X 

14300  MAT  X=D1*£;1 

14310  MAT  :<■(.  5*  Del  t  >#X 
14320  MAT  Xk»X<+X 

14330  DISP  xk<»;; 

14340  Tk«Tfc*Delt 

14350  NEXT  !•; 

14360  ! 

14370  Mag"SQR<DOf< Xk , Xk ) >  !  Normalize  Euler  parameters. 

14380  MAT  Xk:*Xk'<Mag> 

14390  !  Confute  time  derivative  of  covariance  matrix  at  time  t(final). 

14400  W(l)»Wl(61> 

14410  M(2)-W:2(61> 

14420  W(3)-W3(61> 

14430  ! 

14440  CALL  M.ita(l,W(*>,Xk(*),All(*),A12(*>> 

l 4450  CALL  D-tr  i  v  (  P 1 1  p  (  *  >  ,  P2  1  p  (  *  >  ,  P2 2p (  *  >  ,  Q  (  #  >  ,  A 1 1  (  *  >  ,  A 1 2 (  #  )  ,  K 1  (  *  )  ,  L  1  (  *  >  > 

14460  ! 

14470  !  Cospute  updated  covariance  matrix. 

14480  ! 

14490  MAT  Sumk*$ jmk+K  1  f  Compute  upper-left  4x4  matrix. 

14500  MAT  SuMk«Sjmk«<Step''2> 

14510  MAT  PI  1«P1 HSuirk 

14520  MAT  Suml *Suml *1 1  I  Compute  lower-left  3x4  matrix. 

14530  MAT  Suml >S jml * ( St ep/2) 

14540  MAT  P2l«P2HSuirl 
14550  MAT  P2.2p*Q  22* (Step) 

14360  MAT  P22»P22+P22p 

14370  I  Fill  the  upper  left  4x4  of  the  covariance  matrix. 

14580  FOR  I* l  TO  < 

14590  FOR  .!■!  TO  4 
14600  P<1, J)«P11(I,J) 

14610  NEXT  J 
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14620  NEXT  1 

14630  I  Fill  the  lower  left  3x4  pert  of  covtritnce  matrix 

14640  I  eid  the  upper  4x3  pert  with  the  transpose. 

14650  FOR  I-l  TO  3 

14660  FOR  J»1  TO  4 

14670  P<4+I, J',-P21<I, J> 

14680  P<J,4+I>P21<I,  J> 

14690  NEXT  J 

14700  NEXT  I 

14710  FOR  I-l  TO  3 

14720  FOR  J‘l  TD  3 

14730  P<4*l,4+j:-P22<I, J) 

14740  NEXT  J 
14750  NEXT  I 
14760  I 

14770  REDIM  Xk<7> 

14780  ! 

14790  DISP 
14800  SUBEND 


1 
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Secant 


Subroutine  Secant  uses  the  secant  method  to  update  the  parti  cal 

derivative  matrix  used  for  least-squares  correction  (containing  the 

derivatives  of  image  coordinates  with  respect  to  the  Euler  parameters, 

8).  If  we  let  X  =  X(8)  be  the  set  of  function  (colinearity  equations) 

which  produce  image  coordinates  for  stars  as  a  function  of  Euler  para- 

k  k 

meters,  then  at  the  kth  iteration  we  have  8  »  the  coordinates  X  ,  and 

the  partial  derivative  matrix  A  =  3X/36|k  (determined  by  Dxdbeta ) . 

k  k+1  k  k 

By  least-squares  we  obtain  corrections  to  6  to  get  8  =  8  +  A8  . 

k+1 

These  are  used  to  compute  new  coordinate  X  so  the  changes  are 
SXk  =  Xk+1  -  Xk. 

However,  the  linearly  predicted  changes  in  X  are 

.vk  _  /ik  .0k 
AX  =  A  AB  . 

We  proceed  to  modify  the  derivative  matrix  (be  adding  corrections)  so 
that  the  linearly  predicted  changes  will  agree  with  the  actual  changes: 

6Xk  =  (Ak  +  Ck)A8k. 

No  unique  solution  to  this  equation  exists  so  we  introduce 

<j>  =  EI(C.,  )2  and  minimize  this  criterion  subject  to 
ij  J 

6Xk  -  Ak  ABk  -  Ck  A8k  =  0. 

Using  the  Lagrange  multiplier  technique  we  minimize 

$  =  E  E(Ci.k)2  +  AT(6Xk  -  Ak  A8k  -  Ck  A6k). 
i  j 

The  necessary  conditions  require 
94>/aCi.k  =  0 

*  J 
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34/3Xi  =  0 
or 

k  1  k 

V  ■  I i8S 

and 

6Xk  -  Ak  A8k  -  Ck  A8k  =  0. 

Matrix  C  can  be  expressed  as  the  outer  product  of  two  vectors: 

Ck4  A(A8k)T. 

i/ 

We  can  now  substitute  for  matrix  C  in  the  second  necessary  condition 
and  solve  this  equation  for  the  Lagrange  multipliers: 

A  =  2(SXk  -  Ak  A0k)/(A8k)T  A8k 

and  substitute  this  for  A  in  the  first  necessary  condition.  Thus,  the 
updated  partial  derivative  matrix  is 

Ak+1  =  Ak  +  (6Xk  -  AkABk)(A8k)T/(A$k)T  Agk  . 

The  secant  method  works  best  when  we  are  near  the  solution  vector, 
A0.  As  a  check  on  the  performance  of  this  method,  we  compute  the  root- 
mean-square  difference  between  calculated  and  measured  coordinates  at 
each  iteration.  If  this  parameter  ever  increases  from  its  last  value, 
we  start  over  with  exact  derivatives  (computed  by  Dxdbeta)  before 
continuing  with  the  least-square  correction. 


183 


****************  ********************************************** 
•  * 

*  SECANT  * 

*  * 
*************************************************************** 


7850 

7860 

7870 

7880 

7890 

7900 

7910 

7920 

7930 

7940 

7950 

7960 

7970 

7980 

7990 

8000 

8010 

8020 

8030 

8040 

8050 

8060 

8070 

8080 


I  Secant  mtthoc  of  derivative  update. 

SUB  Secant  <A<*>,Delx<*>, Ddy <*> , Idi m, Jdi m> 

OPTION  BAS-  1 

DIN  T1  :i,Jdiw),T2CIdim,  l>,T3<Idim,Jdim),  Sumat  <  Idi  m> 

j 


DISP 


"Sec  ait " 

j 


Sumt2=OOT  <  De 1 x, Dc 1 x) 

NAT  Sumat * 4*De 1 x 
NAT  Sumat*Ody-Sumat 
NAT  Sumat * Sumat ✓(Sumt 2 > 

j 

FOR  1*1  TO  Idiir 
T2< I . l)=3umat(I) 

NEXT  I 

FOR  J*l  TO  ^dirr 
T 1 < 1 ,J)*0eIx<J> 

NEXT  J 


!  Predicted  changes  in  coordinates. 

!  Difference  between  actual  and  predicted 
<  changes. 

!  Fill  vectors  for  outer  product. 

!  <see  Appendix  of  Final  Report. > 


MAT  T3:=T2* T 1 
NAT  A»A*T3 


!  Compute  corrections  to  derivatives. 
!  Add  corrections. 


DISP 

SUBENO 
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Sort 

This  subroutine  sorts  an  array  and  a  column  vector  according  to 
the  values  in  the  column  vector.  The  order  of  sorting  is  from  the 
largest  to  the  smallest  values  and  the  array  and  vector  must  have  the 
same  number  of  rows.  We  use  a  simple  "bubble"  sort  method  -  make  repeated 
searches  through  the  list,  each  time  bringing  the  next  largest  value  to 
the  next  available  location  in  the  list.  In  this  version,  in  order  to 
save  computer  time,  we  use  a  vector  to  save  the  re-ordering  sequence 
of  the  column  vector  and  use  this  sequence  to  re-order  the  array  as  the 
last  step. 


**####*###**•♦**** ***«#******#*«**#*#***#*#«•**•*•##«**#***#*#• 
*  * 


*  SORT 

* 


* 

* 


****************  *********************************** ************ 


9730 

!  This  subroutine 

sorts  arrays  by  rows,  given  a  parameter  vector  of 

9740 

!  seme  dim»nsicn 

as  the  number  of  rows. 

9750 

SUB  Sort  <PO  >,  SHORT  B<*> ,  REAL  N,M> 

9760 

OPTION  BPS;  1 

9770 

DIM  C<N),S<M,M> 

9780 

I 

9790 

DISP  “Sort " 

9800 

i 

9810 

FOR  K=l  TO  H 

9820 

C<K);*K 

!  Fill  i ndex  vector. 

9830 

NEXT  K 

9840 

N1*N-1 

9850 

! 

9860 

FOR  K=l  TO  Ml 

1  Bubble  sort  —  bring  largest  value  to  top. 

9870 

Jj=K 

9880 

Test  *P<K> 

9890 

K 1  =K+  1 

9900 

FOR  ( =K 1  TO  F 

9<ai0 

IF  Test :  fl< I > 

THEN  Continue  !  Search  for  largest  value. 

9920 

J  j-*I 

9930 

Te  it=fl<  J ) 

9940  Continue:  NEXT  1 

9950 

IF  J.j=K  THEN  Conti  nue2 

9960 

P<Jj  >-P<C 

9970 

P<K>;*Test 

!  Place  next  largest  value  in  next  location. 

9980 

T»C<IO 

9990 

C<K>=*C<Jj: 

1  Switch  indices  as  well. 

10000 

C<Jj  >«T 

10010 

Cont i nue2: 4EXT  K 

1O020 

! 

10030 

FOR  1*1  TO  M 

10040 

K=C <  I) 

10050 

FOR  l.-l  TO  M 

10060 

S<  l,L)*Ii<K,L) 

!  Reorder  array  in  same  ordei - refer  to  index  vector. 

10070 

NEXT  L 

10080 

NEXT  I 

10090 

j 

10100 

MPT  B«3 

10110 

I 

10120 

DISP 

10130 

SUBEND 

AD-A103  806  VIRGINIA  POLYTECHNIC  INST  AND  STATE  UNIV  BLACKSBURG  —ETC  F/6  17/7 
STAR  PATTERN  RECOGNITION  AND  SPACECRAFT  ATTITUDE  DETERMINATION. CU) 
MAY  81  T  E  STRIKWERDA.  J  L  JUNK  INS  DAAK70-78-C-0038 

UNCLASSIFIED  ETL-0260  NL 
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Sample  output  from  data  generator  program  (DATGEN): 
Program  setup,  data  for  frame  2  and  beginning  of  frame  3. 


MNMMtt##**  PROGRAM  DATGEN  §•»»•»»»•#•• 

Do  you  want  :o  uic  realistic  gyro  rate  history  (Y/N>?  Y 

Pises  disk  with  gyro  rates  <Fi 1  enm!  '  Wtrue '  >  In  :F8,1 . then  push  CONT. 

Pises  stsr  catalog  disk  (Filenames:  'Tab22'  snd  'Miss220'>  in  :F8,1... 

. ..thsn  push  CONT. 

Hss  Tsbls  of  Sts'*  cstslog  csll  positions  bssn  rssd-i n?<Y'N>  N 

Fils  name  for  sinulation  run  < "Si mnnn: F8, i ' . . . whsrs  nnn  is  3  nun. ): 

Si m042: F8, 1 

Period  :  90.03  mirutss 

Do  you  want  variatiors  in  Eulsr  para,  relating  V  frame  to  Gyro  frame  (Y-'N)?  Y 

Do  you  want  variatiors  in  Euler  para,  relating  B  frame  to  A  frame  <Y^N>?  V 

Do  you  want  ;ime  warding  gyro  biases  <Y^H>?  Y 

Do  you  want  ;o  add  nc  i  ss  to  image  coordinatss<Y/,N>?Y 

Do  you  want  nois?  adeed  to  rate  gyro  data  <Y/N>?Y 
Position  (km)  and  velocity  <km/sec>  of  Satellite: 

6. 6526E+03  0.8380E+00  0.0000E+00 

0.0000E+00  2. 0334E+00  7.4768E+00 

Matrix  GM: 

0.000000  .258319  .965926 

0.000000  - . 965326  .258819 

1 . 000000  0 . 000  300  0 . 000000 

Bug. . . nomi nal  Euler  Parameters  between  frames  V-G: 

1.000000  0.000380  0.000000  0.000000 

Bug... true  Euler  Parameters  between  frames  V-G: 

1.000000  0.000380  .000015  0.080000 

Bvn. . . Ini t i al  Euler  Parameters  between  frames  V-N: 

.092295  ,?013‘?  .092297  .701068 


**********  FRAME  :  2  *********** 

Matrix  VG: 

1.000000  0.008380  -.000029 

0.000000  1.080380  0.000000 

.000029  0.000380  1.000000 

Satellite  time  f-om  start  of  simulation:  30.00  seconds 

Bun... True  Euler  Parameters  between  frames  V-N: 

.090640  .688386  .093727  .713240 

Bba. .. Nomi nal  Euler  Parameters  between  frames  B-R: 

.707107  .707187  0.000000  0.000000 

Bba. ..True  Euler  Parameters  between  frames  B-A: 

.707131  .707383  .000097  0.000000 


da 
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Matrix  Bfl  : 

1.000000  . 000 1  07  -.00013? 

.000137  . 000  969  1.000000 
.000137-1.000300  .000069 

Position  <km>  and  velocity  <kr»/sec>  of  Satellite 
6. 6485E+03  6.0390E+01  2.2426E+02 

-2. 7014E-01  2.0322E400  7.4723E+00 

Position  <k*>  and  velocity  (km'sec)  of  Earth: 

- 1 . 4960E+08  8.13<3E*02  -3.5630E+02 

1 . 7790E-04  2.7314E401  -1.1877E+01 

Total  velocity  of  satellite  <km/sec>: 

-2. 6997E-01  2.9317E-»0l  -4 . 4043E+00 


Matrix  RN: 


.999384 

.008706 

.033971 

.025019 

.508303 

-.865442 

-.024602 

.865759 

.499855 

Bores i ght 

unit  vector 

e 

• 

-.024602 

.865759 

.499855 

Polar  angle:  63.01 

Longitude 

angle:  91 

.63 

Indices  for  'our  cells: 

16  16 

14  1< 

8  9 

»  0 

Number  of 

stars  from 

the  cat  a 

Number  of 

stars  in  trie  FOV: 

True  image 

coordinates  <mm): 

5. 128090 

2.681 500 

4.503000 

4.462200 

3. 126360 

4.509000 

2.580310 

2.440360 

4.810000 

.891715 

.633460 

3.244000 

-1.584060 

.529351 

2.990000 

5.024780 

-2 . 588  570 

3.085000 

-.543383 

-3.457300 

4. 166000 

-.950058 

-4.17?  ?<-0 

4.574000 

-4.615360 

-3.573700 

4.966000 

-4.840800 

-1 . 151 500 

4.936000 

Measured  image  coordinates  <mi 

5. 125990 

2.680390 

4.523250 

4.458730 

3.124300 

4.560540 

2.581860 

2.440350 

4.862560 

.896847 

.637305 

3.259580 

-1.582270 

.524518 

2.987110 

5.018640 

-2.58?*<0 

2.961420 

-.547052 

-3.453350 

4. 174510 

-.953583 

-4. 175710 

4.633090 

-4.610930 

-3.573390 

4.875600 

-4.840900 

-1  .  151770 

4.929290 

Matrix  RN: 

.999391 

.008706 

.033784 

-.024464 

.865795 

.499801 

-.024884 

- . 500323 

.865481 

Bores i ght 

unit  vector 

• 

• 

-.024884 

-.500323 

.865481 

14.00 


10.00 


Polar  angle 


33.06 
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Longitude  Angle:  267.19 
Indices  for  *our  cells: 

8  8  6  6 

13  12  ID  9 


Number  of 

stars  from 

the  catalog: 

9.00 

Number  of 

st ars  In  th»  FOV:  5. 

00 

True  image 

coordinates  (mm>: 

.438158 

-3.896320 

2.313000 

2.604860 

-3.363190 

4.900000 

9.975850 

-1.474120 

4.839000 

-3.296980 

-2.229360 

4.825000 

-1.927940 

2.696350 

4.342000 

0.000000 

0.000300 

0.000000 

0.000000 

0.000300 

0.000000 

0.000000 

0.000300 

0.000000 

0.000000 

0.000300 

0.000000 

0 . 000000 

0.000380 

0. 000000 

Measured  image  coordinates  (mm): 

.437323 

-3.897300 

2.321970 

2.603590 

-3.365270 

4.866520 

5.579470 

-1.471 220 

4.821620 

-3.305680 

-2.229210 

4.858870 

-1.928110 

2 . 694 1^  0 

4.363480 

0.000000 

0.000300 

0.000000 

0.000000 

0.000300 

0.000000 

0.000000 

0.000300 

0.000000 

0.000000 

0.000300 

0.000000 

0.000000 

0.000390 

0.000000 

Bi  ases. . .  true  values 

■ 

• 

-.000007 

.000310 

-.000015 

Frame:  2 

Number  of 

stars:  10  5 

********** 

FRAME  :  3 

*********** 

Matrix  VG: 

1.000000 

.000308 

-.000029 

-.000008 

1 .000300 

-.000003 

.000029 

.000303 

1.000000 

Sat  el  1 i te 

time  f-om 

start  of  simulation: 

Bvn. . . True 

Euler  Par 

ameters  between 

frames 

V- 

.089034 

.676167 

.095378  .725102 

Bba. . . Nomi nal  Euler 

Parameters  between  frames 

.707107 

.707107 

0.000000  0.000000 

Bba. . .True 

Euler  Parameters  between 

frames 

B- 

.707139 

.707375 

.000095  .000003 

Matrix  BA 

A 

• 

1.000000 

.0001*0 

-.000130 

.000130 

.000390 

1.000000 

.000140 

-1 .000300 

.000090 

Position  <k*>  And  velocity  (km^sec)  of  SAtellite: 

6. 63646+83  1.231 1E+02  4.48256+82 

-5.3996E-01  1 . 9395E+00  7.4586E+00 

Position  <kM*  And  velocity  (km/'sec)  of  Earth: 
-1.49606+08  1.63896+03  -7. 1260E+02 

3.5581E-04  2. 7314E+81  -1.1877E+01 

TotAl  velocity  of  SAtellite  <km/sec>: 

-9. 3960E-01  2.93J3E+01  -4.4180E+00 
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Sample  output  from  data  analysis  program  (COMBIN): 

Program  setup  and  beginning  of  frame  2. 

####**##§##§♦###»♦###  PROCESS  B  RHP  C 
Doing  Proc  B  V 

Doing  Proc  C  (Y/''C?  Y 

Insort  star  catalog  cisk  into  F8,l....Then  press  CONT 
Has  coll  table  been  read-in?  N 

Input  file  name  and  ceuice  with  simulation  data:  Sim042:F8,l 

Satellite  orbit  najor  axis  <km>:  6653 

Earth  orbit  wajo'1  axis  <km):  1 . 4960E+08 

Satellite  orbit  inclination  (deg.):  75 

Rate  gyro  da; a  soacirg  (sec):  .50 

Runge-Kutta  ;ime  step  (sec):  30.00 

Gyro  standard  deviation  (r ad/'sec):  4.848E-06 

Input  weight  in  ar-cseconds  for  interlock  variance  (2, 5, etc.)  5.000 
Input  Gyro  B i as  Stancard  Deviation  (Degrees/Hr )  .50 

Q  Matrix: 

2. 350E-1 1  0.03OE+e0  0. 000E+00 

0. 000E+00  2. 350E-1 1  0 . 000E+00 

0 . 000E+00  0. 03OE+E0  2. 350E-1 1 

Do  you  want  ;o  offset  matrix  VG  <V-frame  to  Gyro  frame)  N 

Matrix  VG  for  this,  rcn: 

1 . 000E+09  0.03OE+C0  0 . 000E+00 

0. 000E+00  1.03OE+C0  0.000E+00 

0. 000E+00  0. 03OE+C0  1.000E+00 

RECORD  HUMIER 

Bvn....True  l-ule-  parameters  between  V  and  N  frames: 

.090671  .683716  .093893  .713186 

Bba. ...True  Eule*  parameters  between  B  and  A  frames: 

.707131  . 707883  .000097  0.000000 

Bba. ...  Current  Ejler  parameters  between  B  and  R  frames: 

.707131  .707083  .000097  0.000000 

Components  o'  total  velocity  (km^sec): 

-2. 700E-01  2.932E+E1  -4.404E+00 

Number  of  stars  in  each  FOV: 

FOV(R):  10 
FOV(B>:  5 

Bvn. ...  Integrated  Euler  parameters  between  V  and  N  frames 
and  gyro  biases: 

.089241  . 676921  .095545  .725192 

0.000E+00  0.003E+0E  0. 000E+00 

Components  o'  total  velocity  (km/sec): 

-2. 700E-01  2. 932E+C 1  -4.404E+00 


Sample  output  from  data  analysis  program  (COMBIN) 
Analysis  of  data  from  frame  5. 


********  record  huhier:  s  %**••.*«.***» 

Bvn....True  liu I • '  parameters  between  V  and  N  frames: 
.085633  .653' 46  .096509  .748253 

Bba.  ...True  Gule"  parameters  between  B  and  A  frames: 
.707153  .707061  .000084  .000018 

Bba. ...  Current  Ejler  parameters  between  B  and  A  frames: 
.707146  .707067  .000099  -.000080 

Components  o'  total  velocity  Ocm'sec): 

-1 . 077E+00  2. 930E+6 1  -4.473E+00 

Number  of  stars  in  each  FOV: 

FOV<A):  8 

F0V<8>:  6 

Bun. ...  Integrated  Euler  parameters  between  V  and  N  frames 
and  gyro  biases: 

.085706  .650376  .098562  .748299 

-5. 633E-06  4.482E-06  -1.359E-05 

Components  o'  total  velocity  <km'sec>: 

- 1 . 077E+00  2.938E+C1  -4.4?3£*00 


Start  for  FOVtfi) 

Boresigbt  direction  cosines  for  FOV<A>: 
-.098483  .864305  .493232 

Polar  angle:  60.'-  Degrees 
Longitude  angle:  96.5  Degrees 

Cel  I  i ndi ces : 

16  16  14  14 

9  8  8  7 


Table  of  CosJTheta)  for  Measured  Stars. 
Star  Star  CosOheta) 

1  2  . 93'  825 

l  3  . 93370C 

1  4  .937851 

2  3  .939822 

1  5  .937526 

2  4  .930894 

1  6  . 93872c 

2  5  .935755 

3  4  .930641 

1  7  .938602 

2  6  .937735 

3  5  . 935*966 

1  8  .938382 

2  7  .938021 

3  6  .937476 

4  5  .938695 

2  8  .93899E 


k 
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3  7  .9  37766 

4  6  . 997697 

3  8  .990535 

4  7  .99739: 

5  6  . 9  39436 

5  7  . 999346 

5  8  . 990429 

6  8  .99774: 

7  8  .99744: 

Begin  Pairing  Catalog  Stars  and  Comparing  To  Measured  Pairs 

Number  of  stars  from  catalog:  15 
Star  Star  Cos (Theta) 

1  2  .999996 

1  3  .99001: 

>>>>>  Catalog  Pair  Matched  with  Measured  Pair  <<<<< 

Measured  pair: 

Star  Star  Cos(Theta) 

7  2  .990021 

Least -Squares  Correction  For  One  FOV 

RMS  error  for  normal i zed  image  coordi nates: 1 . 6748E-04 

Beta(old)  Beta. (new)  Delta(Beta) 

.0857057  .08:2774  -.0004283 

. 6503763  .6569618  .0005855 

.0985616  .0969390  .0003773 

.7482986  .7477891  -.0005095 

RMS  change  in  Eulir  parameters:  4.8172E-04 

RMS  error  for  normalized  image  c oordi nat es : 2. 3 1 34E-05 

Beta(old)  Beta(new)  Delta(Beta) 

.0852774  .08:2771  -.0000003 

.6509618  .6569621  .0000003 

.0989390  .8969394  .0000004 

.7477891  .7477882  -.0000009 

RMS  change  in  Euler  parameters:  5.4913E-07 
Number  of  iterations:  2  Converge"! 


Test  for  Additional  Stars 


x(calc ) 

x(meas) 

y <c  al c  ) 

y(meas ) 

Dx 

Dy 

.3588 

.3567 

-1.1708 

-1.1696 

.0021 

.0012 

.6301 

.  6335 

-1.3228 

-1.3184 

.0034 

.0044 

-3.6080 

-3. 6060 

1.0902 

1.0890 

.0021 

.0012 

3.7541 

3.  '*560 

.5865 

.5992 

.0019 

.0128 

1.0280 

1.8338 

-3.7184 

-3.7160 

.0058 

.0024 

Start  for  FOV < ID 

Boresight  direction  cosines  for  F0V<8>: 
-.096652  -.501563  .059646 

Polar  angle:  30.7  Degrees 
Longitude  angle:  259.1  Degrees 

Cell  indices: 

0  8  6  6 

12  13  9  10 


192 


Tabic  of  Cos(Theta)  for  Measured  Stars. 

Star  Star  Cos(Theta) 

1  2  .995801 

1  3  . 99875E 

1  4  .93163$ 

2  3  . 997*596 

1  3  .932972 

2  4  .937046 

1  6  .933075 

2  5  .932736 

3  4  .936696 

2  6  .931646 

3  5  .937282 

3  6  . 9  38925 

4  5  .937517 

4  6  .938411 

3  6  .935345 

Begin  Pairing  Catalog  Stars  and  Comparing  To  Measured  Pairs. 

Number  of  stars  from  catalog:  16 
Star  Star  Cos<Theta) 

1  2  .936682 

1  3  .937515 

>>>>>  Catalog  Pair  Matched  with  Measured  Pair  <<<<< 

Measured  pair: 

Star  Star  Cos (Theta) 

3  4  .937317 

Least -Squares  Correction  For  One  FOV 

RMS  error  for  normalized  image  coordi nates: 1 . 2863E-03 

Beta(old)  Jieta(new)  Delta(Beta) 

.0852771  .0853085  .0000315 

.6309621  .6561618  -.0008003 

.0989394  .0968372  -.0001022 

.7477882  .7464948  .0007066 

RMS  change  in  Euler  parameters:  5.3647E-04 

RMS  error  for  normalized  image  c oordi nat es: 9. 5265E-06 

Beta(old)  Bets.Cnew)  Delta(Beta) 

.0853083  .0853081  -.0000004 

.6501618  .6561616  -.0000002 

.0988372  .0968367  -.0000004 

.7484948  .7464943  -.0000005 

RMS  change  in  Euler  parameters:  3.9327E-07 
Number  of  iterations:  2  Converge* 1 


Test  lror  Additional  Stars 


x<calc ) 

x<m«as> 

y<calc> 

y(meas) 

Dx 

By 

1 . 8908 

1.3912 

-2. 1949 

-2. 1940 

.0003 

.0009 

-1.7222 

-1.  M92 

2.4753 

2.4632 

.0031 

.0121 

3.6270 

3.6267 

2.6151 

2.6141 

.0003 

.0009 

-3.6734 

-3.6810 

-2. 1516 

-2. 1678 

.0056 

.0162 

-4.7927 

-4.  '*999 

4.4085 

4.3959 

.0071 

.0126 

Least-Squares  Correction  For  Two  FOV 
Correct  orientation  tsing  3  stars  from  FOV<R>  and  5  stars  from  FOV(B). 


s 


•»  •  H;  ‘  *T 
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RMS  error  in  normalized  image  coordinates:  3.7645E-04 


Euler  parameters 
del t  a-B< V-N) 


B< V-N) 

0656257 

6504280 

0985211 

7482684 


03831*5 
0302664 
0  3031 5  6 
0302259 


and  corrections: 

del ta-B<B-fl> 


B  <  B-fl  > 
7071793 
7070343 
0000228 
0001544 


0000330 

0000329 

0001221 

0001542 


RMS  change  in  Euler  parameters:  2.1310E-04 


RMS  error  in  normalized  image  coordinates:  4.8614E-05 


Euler  parameters 


BCV-N)  de 1 1  a-B<  V-N) 
.0856257  .0380061 

.6504279  -.  03(«00€  1 

.0985212  .0380061 

.7482683  -.0380061 


and  corrections: 

delta-B<B-fl> 


B  <  B-fl  ) 

7071792 

7070344 

0000227 

0001544 


0000002 

0000002 

0000000 

0000000 


RMS  change  in  Euler  parameters:  1.0901E-07 


RMS  error  in  normalized  image  coordinates:  4.8614E-05 


Euler  parameters 
B(V-N)  del t  a- B<V-N> 
.0856237  .0380060 

.6504279  .0380060 

.0985212  .0380060 

.7482683  -.0380060 


and  corrections: 


B<B-fl> 

.7071792 

.7070344 

-.0000227 

-.0001544 


del ta-B(B-fl) 
-.0000000 
,0000000 
.0000000 
.0000000 


RMS  change  in  Euler  parameters:  7.6322E-09 
<End  o(  1 ei st -squares  for  two  FOV> 


Kalman  F i 1 t er  State  Estimation 


True 

8 . 563E-Q2 
6. 504E-01 
9. 851E-02 
7. 483E-01 
-7 . 062E-06 
7.796E-06 
-1 . 725E-05 


_ State 

Integ. 
8.571002 
6. 504001 
9. 85SO02 
*.483001 
5.63  3006 
4.482006 
1.353005 


ec  t  or s _ 

Proc .  B 
8. 563E-02 
6.504E-01 
9.852E-02 
7.483E-01 
-5. 633E-06 
4 . 482E-06 
- 1 . 359E-05 


Opt.  Est. 
8 . 564E-02 
6. 504E-01 
9. 853E-02 
7. 483E-01 
-6 . 234E-06 
3 . 567E-06 
- 1 . 556E-05 


<  I-T) 

7 . 280E-05 
-7. 019E-05 
5. 228E-05 
4 . 579E-05 
1 . 430E-06 
-3.31 4E-06 
3. 656E-06 


Pi f f  erence 
(B-T> 

-7. 171E-86 
-1.861E-85 
1. 184E-05 
1 . 544E-05 
1.430E-06 
-3. 314E-06 
3. 656E-06 


< 0-T  ) 

5. 125E-06 
-2.872E-05 
1 . 64  IE- 05 
2.231E-05 
8.284E-07 
-2. 230E-06 
1 .685E-06 


Norm  of  optimal  estimate  -  1:  .00000007 


<end  of  frame) 


